Adaptive Control of MEMS Gyroscope Based on Global Terminal Sliding Mode Controller

An adaptive global fast terminal sliding mode control (GFTSM) is proposed for tracking control of Micro-Electro-Mechanical Systems (MEMS) vibratory gyroscopes under unknownmodel uncertainties and external disturbances. To improve the convergence rate of reaching the sliding surface, a global fast terminal sliding surface is employed which can integrate the advantages of traditional sliding mode control and terminal sliding mode control. It can be guaranteed that sliding surface and equilibrium point can be reached in a shorter finite time from any initial state. In the presence of unknown upper bound of system nonlinearities, an adaptive global fast terminal sliding mode controller is derived to estimate this unknown upper bound. Simulation results demonstrate that the tracking error can be attenuated efficiently and robustness of the control system can be improved with the proposed adaptive global fast terminal sliding mode control.


Introduction
MEMS gyroscopes are the basic measuring elements of inertial navigation and inertial guidance system, which are commonly used for measuring angular velocity.Because of their enormous advantages in size and cost, MEMS gyroscopes have a wide range of applications in the area of navigation, platform stabilization, control, and traffic.But, due to the manufacturing error and the temperature disturbance, which can cause deviations from the desired qualities and degrade the performance of a gyroscope.Besides, MEMS gyroscopes belong to MIMO systems, which have parameter uncertainties and are vulnerable to external environment influence.Therefore, it is necessary to solve these challenges by utilizing advanced control methods.In the last few years, many advanced control approaches have been proposed to enhance performance and robustness of MEMS gyroscope.Batur et al. [1] developed a sliding mode control for MEMS gyroscope system.Leland [2] presented an adaptive controller for tuning the natural frequency of the drive axis of a vibratory gyroscope.Park et al. [3,4] presented an adaptive controller for a MEMS gyroscope which drives both axes of vibration and controls the entire operation of the gyroscope.Adaptive controller has been developed using sliding mode control to control the vibration of MEMS gyroscope [5].Raman et al. [6] proposed a closed-loop digitally controlled MEMS gyroscope using unconstrained sigma-delta force balanced feedback control.Tsai and Sue [7] developed integrated model reference adaptive control and time-varying angular rate estimator for microgyroscopes.
As we know, sliding mode control has many attractive features such as robustness to parameter variations and insensitivity to disturbance.The basic idea of the sliding mode control is to drive and maintain the system trajectory on a sliding surface designed a priori in the state space.However, one of the representative characteristics of conventional sliding mode control is that the convergence of the system states to the equilibrium point is usually asymptotical but not in finite time.Recently, a new type of sliding mode control technique called terminal sliding mode control is developed.Instead of using linear hyperplanes as the sliding surfaces, the terminal sliding mode control adopts nonlinear sliding surfaces.With the nonlinear sliding surfaces, the terminal sliding mode controller can make the system states reach the equilibrium point in a finite time period.Saif et al. [8] presented a novel methodology for approximation of the unknown time-varying rotation rate by using a sliding mode observer along with a robust control system based on terminal sliding mode control for improving the performance of the MEMS gyroscope.Zhu and Chai [9] presented a global finite-time tracking controller based on terminal sliding mode control method for the trajectory tracking control problem of biped multilinked robots with uncertain disturbances.In order to solve the optimal problem of convergence time and estimate the unknown upper bound of system uncertainties, much research has been done to apply intelligent control approaches such as the adaptive global fast terminal sliding mode control.Feng et al. [10] and Keleher and Stonier [11] proposed an adaptive fast terminal sliding mode tracking control scheme for robotic manipulators to estimate the upper bound of uncertainties.Tao et al. [12] developed a new adaptive fuzzy terminal sliding mode controller for linear systems with mismatched time varying uncertainties.Zhang et al. [13] proposed a new approach of adaptive fuzzy global identical terminal sliding mode control for cross-beam system.Neila and Tarak [14] designed adaptive terminal sliding mode control for rigid robotic manipulators.Feng et al. [15] proposed a nonsingular terminal sliding mode controller for rigid manipulators.In this paper, robust adaptive global fast terminal sliding mode control strategy for trajectory tracking control of MEMS vibratory gyroscopes is proposed.The main motivations in the paper are highlighted as follows.
(1) A global fast terminal sliding mode surface is designed to improve the convergence rate of reaching the sliding surface.It integrates the advantages of traditional sliding and terminal sliding control, and guarantees that the tracking error can converge to zero in a shorter finite time.Adaptive control and terminal sliding control are successfully integrated with MEMS gyroscope.
(2) An adaptive global fast terminal sliding mode control is incorporated into the MEMS gyroscope to improve the tracking performance and strengthen the robustness of the control system.With this control, the upper bound of model uncertainties and external disturbances are not needed because the proposed controller can estimate the upper bound of these uncertainties using an adaptive mechanism.Also, the proposed controller eliminates the chattering effect without losing the robustness property and the precision.
This paper is organized as follows.In Section 2, the dynamics of MEMS gyroscope are described.In Section 3, global fast terminal sliding mode control is introduced.In Section 4, the proposed adaptive global fast terminal sliding mode controller is derived and the stability of this control system is proved by Lyapunov's stability theory.Simulation results are presented in Section 5. Finally, conclusions are provided in Section 6.

Dynamics of MEMS Gyroscope
A -axis MEMS gyroscope is depicted in Figure 1.Generally, a typical MEMS vibratory gyroscope includes a proof mass suspended by spring beams, electrostatic actuations, and sensing mechanisms for forcing an oscillatory motion and sensing the position and velocity of the proof mass.Dynamics of a MEMS gyroscope are derived from Newton's law in the rotating frame.
As we know, Newton's law in the rotating frame becomes In (1),   is the total applied force to the proof mass in the gyro frame,  phy is the total physical force to the proof mass in the inertial frame,  centri is the centrifugal force,  Coriolis is the Coriolis force,  Euler is the Euler force, and   is the acceleration of the proof mass with respect to the gyro frame. phy ,  Coriolis , and  Euler are inertial forces caused by the rotation of the gyro frame.
With the definition of   and V  as the position and velocity vectors relative to the rotating gyroscope frame, and Ω as the angular velocity vector of the gyroscope frame, the expressions for the inertial forces are reduced to then, where  phy contains spring, damping, and control forces applied to the proof mass.In a -axis MEMS gyroscope, by supposing the stiffness of spring in  direction much larger than that in  and  directions, motion of proof mass is constrained to only along the  −  plane.Referring to [16], with assuming that the gyroscope is almost rotating at a constant angular velocity Ω  over a sufficiently long time interval, the dynamics of gyroscope based on (3) are simplified as follows: where  and  are the coordinates of the proof mass with respect to the gyro frame in a In (5),   and   are damping coefficients,   and   are spring coefficients,   and   , called quadrature errors, are coupled damping and spring terms, respectively, mainly due to the asymmetries in suspension structure and misalignment of sensors and actuators.The coupled spring and damping terms are unknown, but can be assumed to be small.The nominal values of the and -axes spring and damping terms are known, but there are small unknown variations.The proof mass can be determined accurately.
Dividing both sides of (5) by ,  0 , and  2 0 , which are a reference mass, length, and natural resonance frequency, respectively, we get the form of the nondimensional equation of motion as where The vector form of MEMS gyroscope dynamics model can be written as where Considering the system with parametric uncertainties and external disturbance, the dynamics of MEMS gyroscope (7) can be expressed as q + ( + 2Ω + Δ) q + ( + Δ)  =  + , (8) where Δ is the unknown parameter uncertainties of the matrix +2Ω, Δ is the unknown parameter uncertainties of the matrix , and  is an uncertain extraneous disturbance.
The control target for MEMS gyroscope is to find a control law so that the proof mass position q() can track the desired trajectory q  ().In addition, in the presence of model uncertainties and external disturbances, a robust control design is required to improve the robustness and tracking resolution of the control system.In this paper, adaptive global fast terminal sliding mode control is designed to make the system track the desired trajectory and improve the system robustness in the unknown model uncertainties and external disturbances.

Global Fast Terminal Sliding Mode Control
The traditional fast terminal sliding mode form can be defined as where  1 ∈  1 is state variable,  0 > 0 is constant, and  1 and  2 are odd positive integers satisfying  1 >  2 .Given an initial state  1 (0) ̸ = 0, the system will reach the equilibrium point  1 = 0 along the sliding mode (9) in finite time  1 .The time to reach  1 = 0 from  1 (0) ̸ = 0 is determined by The global fast terminal sliding surface can be defined as where  0 > 0 is constant.Given an initial state  1 (0) ̸ = 0, the system will reach the equilibrium point  1 = 0 along the sliding mode (11) in finite time  2 .The time to reach  1 = 0 from  1 (0) ̸ = 0 is determined by Referring to [17], we can demonstrate that  2 ≤  1 .Comparing ( 9) and (11), it can be seen that the convergence times of the two types of terminal sliding modes are all determined by the fast terminal attractor ẋ 1 = − 0  when it is far from the equilibrium point.At this time, their convergence rates are basically the same.But when close to the equilibrium point, the convergence time of global fast terminal sliding mode is mainly determined by the linear sliding mode ẋ 1 = − 0  1 and the convergence rate accelerates exponentially.At this time, its convergence rate is much better than the traditional fast terminal sliding mode.Remark 1.The global fast terminal sliding mode not only introduces the fast terminal attractor, making the system state converge in finite time, but also keeps the rapidity of the linear sliding mode when it is close to the equilibrium state, so as to realize the goal of that the system state will converge to the equilibrium state quickly and accurately.

Adaptive Global Fast Terminal Sliding Mode Control
The global fast terminal sliding mode control that is put forward has solved the optimal problem of convergence time.It integrates the advantages of traditional sliding mode control and terminal sliding mode control in the design of sliding mode and uses the concept of fast access to the equilibrium point at the arriving stage to ensure that the tracking error converges to zero in a shorter finite time.However, as a result of the design principle that is similar to the traditional sliding mode control, there still exists chattering in the global fast terminal sliding mode control signals.Also, the uncertainty boundary needs to be known in advance, and it is hard to accomplish that in actual MEMS gyroscopes.In allusion to the trajectory tracking control of MEMS gyroscopes with unknown model uncertainties and external disturbances, a new adaptive global fast terminal sliding mode control algorithm is synthesized in this section, which uses the respective advantages of adaptive and sliding mode control and the estimates of unknown uncertainty which can be obtained by adaptive control.
The block diagram of an adaptive global fast terminal sliding mode control for a MEMS gyroscope is shown in Figure 2, the tracking error between expectation state and gyroscope state comes to the global fast terminal sliding mode controller.The adaptive global fast terminal sliding mode controller is proposed to control the MEMS gyroscope.The unknown upper bound of system uncertainties can be identified by adaptive estimator.

Design of Global Fast
Terminal Sliding Mode Surface.The tracking control problem of a MEMS gyroscope is what this paper considers, so the control target is to design a suitable control law to make the system output  track the state of the desired trajectory   completely in finite time.
For the trajectory tracking control of a MEMS gyroscope, two input and two output systems, the global fast terminal sliding surface is chosen as where ]  is the system tracking error, and   is the desired trajectory.In the sliding mode   = [ 1 ,  2 ]  , the system reaches the equilibrium state  = 0 from any initial state (0) ̸ = 0 in finite time   = [ 1 ,  2 ]  .The time   is determined by We can make the system reach equilibrium state in finite time   through setting the suitable parameters , ,  1 , and  2 .After determining the sliding surface, the next step is to design a sliding mode controller to ensure the existence of the sliding mode stage.

Design of Global Fast Terminal Sliding Mode Controller.
In the sliding mode control, the control input should be able to force all the system state trajectories to converge the sliding mode surface  = 0, so as to ensure the existence of the sliding mode stage.The behavior of the sliding mode is equivalent to that of the stability of the state trajectory in the sliding surface.In other words, the control law should be able to ensure that the tracking error converges to zero from any state.
Furthermore, rewriting (8) as where  represents the matched lumped uncertainty and disturbance which is given by We make the following assumption prior to further discussion.
Assumption 2. The lumped uncertainty and disturbance  is input related and if the control input does not contain the acceleration signal, the system uncertainties will be bounded by a positive function of the position and velocity measurements in the following form: where  0 ,  1 , and  2 are unknown positive constants.
Remark 3. If lumped uncertainty and disturbance  is not related to with state position and velocity signals, the system uncertainty will be only bounded by a positive constant  0 .
Using the sliding surface (13), the global fast sliding mode controller is proposed as follows: where  0 is defined in (19),  1 is defined in (20), and  2 is defined in (21).Consider And  has the following expression: where  is a positive constant.
According to [18], it is known that the control system is stable in this control law and reaches the stable point in finite time.But the control law requires that  should be known.We usually choose the larger  conservatively to compensate the system model uncertainties and the upper bound of the disturbances fully, but this often enhances the chattering.
In order to overcome this problem, we introduce a proper adaptation law combining with global fast terminal sliding mode control to realize the adaptive global fast terminal sliding mode control in the next part.This method achieves the goal of tracking system model errors and uncertain disturbances automatically, weakening the chattering and ensuring the stability of the control system.

Design of Adaptive Global Fast Terminal Sliding Mode
Controller.Supposing that b0 , b1 , and b2 are the estimates of  0 ,  1 , and  2 , respectively, the following simple adaptive control laws can realize the estimation of the unknown parameters  0 ,  1 , and  2 .Consider where  0 ,  1 , and  2 are arbitrary positive constants representing the adaptive gains.
Based on the given adaptation law, for the MEMS gyroscope system with the dynamics (15), the adaptive global fast terminal sliding mode controller is designed synthetically as follows, which uses the sliding surface (13): where  0 is defined in (25),  1 is defined in (26), and  2 is defined in (27).
where  = diag ( 1 ,  2 ),   > 0,  = 1, 2, is a designed parameter matrix, and Theorem 4. If the control law (24), with the sliding surface (13) and the adaptation law (23), is applied to the nonlinear uncertain system defined by (15), then the system's tracking error can converge to zero in finite time.
Proof.Let us consider the following positive definite function as a Lyapunov function candidate: where b =   − b and  = 0, 1, 2 are the estimation errors between actual values and their estimated values, respectively.
Remark 5.In the proof of Theorem 4, we used the Rayleigh principle, namely, where  min () and  max () are the minimum and maximum eigenvalues of , respectively.Since  is a diagnose matrix, that is,  = diag [ 1 , . . .,   ],  min () and  max () have the simple types described as follows: min () = min The so-called adaptive global fast terminal quasi-sliding mode control is a control method that the system trajectory is confined to a neighborhood  within the ideal sliding mode.The quasi-sliding mode control adopts normal sliding mode control in the boundary layer outside and continuous state feedback control in the boundary layer, so as to avoid or weaken the chattering.Therefore, the controller (24) is improved as follows: where  is a designed positive parameter; then, the chattering will be eliminated.

Simulation Example
In this section, we will evaluate the proposed adaptive global fast terminal sliding mode control scheme on the lumped MEMS gyroscope sensor model by using Matlab/Simulink.The control objective is to design an adaptive global fast terminal sliding mode controller so that the trajectory  () can track the state of the desired model   () completely in finite time.In addition, the unpredictably upper bound of system uncertainties can be estimated by adaptive estimator.The parameters of the MEMS gyroscope are as follows: Since the general displacement range of the MEMS gyroscope in each axis is sub-micrometer level, it is reasonable to choose 1 m as the reference length  0 .Given that the usual natural frequency of each axis of a MEMS gyroscope is in the KHz range, so, choose the  0 as 1 KHz.The unknown angular velocity is assumed Ω  = 100 rad/s.Then, the nondimensional values of the MEMS gyroscope parameters are listed as follows:  In this simulation example, the initial values of the system are selected as  1 (0) = 1.0, q 1 (0) = 0,  2 (0) = 0.5, and q 2 (0) = 0.The desired motion trajectories are described by  1 = sin() and  2 = cos().The lumped parametric uncertainties and external disturbances given by  =  − Δ q − Δ are composed of model uncertainties and external disturbances.As for model uncertainties, there are ±10% parameter variations for the spring and damping coefficients with respect to their nominal values and ±10% magnitude changes in the coupling terms, that is,   and   with respect to their nominal values.Random signal  = [0.5 * randn(1, 1); 0.5 * randn(1, 1)] is considered as external disturbances.The chosen sliding surface parameters are  1 = 5,  2 = 3,  1 =  2 = 0.25, and  1 =  2 = 0.5 and the initial conditions of the upper bound of the uncertainty are  00 = 0.1,  10 = 0.2, and  20 = 0.3.The adaptive gains are chosen as  0 = 1.0,  1 = 1.6, and  2 = 1.6.The sliding mode controller parameter of ( 26) is  = diag (2, 4)( 1 = 2,  2 = 4).In order to have a small boundary layer around the sliding surface and reduce the chattering, we have chosen the designed positive parameter  equal to 0.06 and used the adaptive global fast terminal quasi-sliding mode control (36).The simulation results are shown in Figures 3-9.Figures 3 and 4 depict the MEMS gyroscope along axis and -axis tracking trajectories using the adaptive global fast terminal sliding mode control law, respectively.From Figures 3 and 4, it can be observed intuitively that after about 3 seconds, the actual motion trajectory of the MEMS gyroscope is consistent with the desired reference trajectory, making the system state track the state of the desired trajectory completely in a shorter finite time.
Subsequently, in order to demonstrate the advantages of the paper, a comparable investigation on MEMS gyroscope model (15) is accomplished between the proposed adaptive global fast terminal sliding mode control and conventional sliding mode control, and the results are shown in Figures 5 and 6, where the tracking errors of -axis and -axis corresponding to adaptive global fast terminal sliding mode control more severely decrease in contrast with the conventional sliding mode control due to the proposed finite time convergence algorithm.Besides, from the Figures 5 and 6, it can be also seen that the tracking errors of adaptive global fast terminal sliding mode control converge to zero in about 3 seconds, which improves the dynamic behavior of the MEMS gyroscope and verify that the adaptive global fast terminal sliding mode control can ensure the global stability of the control system.Moreover, we can set the appropriate sliding mode surface parameters to adjust the convergence rate, so as to improve the work efficiency.Figure 7 describes the convergence of the global fast terminal sliding mode surface ().It is shown that the sliding mode surface converges to zero in a very short time.The global fast terminal sliding mode control has solved the optimal problem of convergence time compared with the traditional terminal sliding mode so that it can make the system state converge to the equilibrium state quickly and accurately.It should be noted that we can also choose appropriate reaching law to improve the convergence rate further, such as ideal reaching law and adaptive reaching law, which have been proposed in recent years.Sliding mode control system utilized these two types of reaching laws that not only can reach the region of the switching surface in finite time but also enhance the dynamic performance of the control system.
Figures 8 and 9 depict the smooth sliding mode control forces of the MEMS gyroscope along -axis and -axis with the adaptive global fast terminal sliding mode controller, respectively.It is clearly observed from Figures 8 and 9 that there is no chattering using the proposed controller.presents the adaptively estimated parameters b0 , b1 , and b2 .These results show a stable convergence of the upper bound parameters.
In the presence of large uncertainties, the global fast terminal sliding mode control can give large tracking error which is not the case in adaptive global fast terminal sliding mode control.Therefore, the introduction of adaptive control technique can adapt to the changes of external environment and control structure parameters, which maintains the optimal performance of the control system.In addition, adaptive technology can effectively solve the robustness problem in the presence of unknown model parameters and external disturbances, so as to improve the MEMS gyroscope's reliability and disturbance rejection ability.

Conclusion
In this paper, we proposed the design of a new adaptive global fast terminal sliding mode controller for trajectory tracking control of MEMS vibratory gyroscopes, which enables the robustness in the presence of parameter uncertainties and the external disturbances.The main feature of this design is that it combines the global fast terminal sliding mode control with a boundary layer and the adaptive approach.
Based on the Lyapunov's stability theory, the system state with the designed global fast terminal sliding mode controller is able to converge to equilibrium point in a shorter finite time.In order to reduce the chattering, we present a softening control approach.Considering the unknown upper bound of system uncertainties, an adaptive global fast terminal sliding mode controller with unpredictably upper bound of parameter estimation is derived.The adaptive algorithm is used to estimate the bounds of uncertainties and external disturbances.Simulation results are provided to demonstrate the validity and reliability of the proposed control scheme.

Figure 1 :
Figure 1: A simplified model of a -axis MEMS Gyroscope.

Figure 2 :
Figure 2: Block diagram of an adaptive global fast terminal sliding mode control for a MEMS gyroscope.

Remark 6 .
=1,..., {  } ,  max () = max =1,..., {  } .(37) Since there are two switching functions sgn in adaptive terminal sliding mode control (26) and (27), there exists chattering in the global fast terminal sliding mode control signals.In order to reduce the chattering, we can use adaptive global fast terminal quasi-sliding mode control instead of adaptive global fast terminal sliding mode control.

Figure 5 :Figure 6 :
Figure 5: Position tracking error of -axis comparison between AGFTSMC and SMC.
Cartesian coordinate system,  , and  , are damping and spring coefficients, Ω ,, are the angular rate components along each axis of the gyro frame, and  , are the control forces in  and  directions.In this design, the control forces are the electrostatic forces in parallel plate actuator which can be expressed as the gradient of the potential energy stored on the capacitor.The last two terms in (4), 2 Ω  ẏ and 2 Ω  ẋ are the Coriolis forces used to reconstruct the unknown input angular rate Ω  .Under typical assumptions Ω  ≈ Ω  ≈ 0, only the component of the angular rate Ω  causes a dynamic coupling between and -axes.Taking fabrication imperfections into account, which cause extra coupling between and -axes, the lumped parameter mathematical model for an actual -axis MEMS gyroscope becomes