Adaptive Control of MEMS Gyroscope Based on TS Fuzzy Model

A multi-input multioutput (MIMO) Takagi-Sugeno (T-S) fuzzy model is built on the basis of a nonlinear model of MEMS gyroscope. A reference model is adjusted so that a local linear state feedback controller could be designed for each T-S fuzzy submodel based on a parallel distributed compensation (PDC) method. A parameter estimation scheme for updating the parameters of the T-S fuzzy models is designed and analyzed based on the Lyapunov theory. A new adaptive law can be selected to be the former adaptive law plus a nonnegative in variable to guarantee that the derivative of the Lyapunov function is smaller than zero. The controller output is implemented on the nonlinear model and T-S fuzzy model, respectively, for the purpose of comparison. Numerical simulations are investigated to verify the effectiveness of the proposed control scheme and the correctness of the T-S fuzzy model.


Introduction
Gyroscopes are commonly used sensors in navigation, automobile, and so forth.The performance of the MEMS gyroscope is often deteriorated by the effects of time varying parameters, quadrature errors, and external disturbances.Advanced control such as adaptive control and intelligent control are necessary to be adopted to control the MEMS gyroscope.In the last few years, various control approaches have been proposed to control the MEMS gyroscope.Increasing attention has been given to the tracking control of MEMS gyroscope.Leland [1] derived two adaptive controllers for a MEMS gyroscope that tune the drive axis natural frequency to a preselected frequency and drive the sense axis vibration to zero for force-to-rebalance operation.Sung et al. [2] proposed a phase-domain design approach to study the mode-matched control of gyroscope.Antonello et al. [3] derived extremum-seeking control to automatically match the vibration mode in MEMS vibrating gyroscopes.Park et al. [4] presented an adaptive controller for a MEMS gyroscope which drives both axes of vibration and controls the entire operation of the gyroscope.John and Vinay [5] developed a novel concept for an adaptively controlled triaxial angular velocity sensor device.Sliding mode control has been incorporated into adaptive controller to control the MEMS gyroscopes [6,7].Model uncertainties and disturbances are inevitable in actual engineering and require the controller to be either adaptive or robust to these model uncertainties.Adaptive fuzzy sliding mode controller can be utilized to compensate the model uncertainties and disturbances since it combines the merits of the sliding mode control, the fuzzy inference mechanism, and the adaptive algorithm.Wang [8] demonstrated that an arbitrary function of a certain set of functions can be approximated with arbitrary accuracy using fuzzy system on a compact domain using universal approximation theorem.Guo and Woo [9] derived adaptive fuzzy sliding mode controller for robot manipulator.Yoo and Ham [10] developed adaptive controller for robot manipulator using fuzzy compensator.Wai [11] proposed fuzzy sliding mode controller using adaptive tuning technique.Chang et al. [12] designed and implemented fuzzy sliding mode formation control for multirobot systems.Chien et al. [13] developed robust adaptive controller design for a class of uncertain nonlinear systems using online T-S fuzzy-neural modeling approach.Stabilizing controller design for uncertain nonlinear systems using fuzzy models was investigated in [14].Park and Cho [15] designed T-S model based indirect adaptive fuzzy controller using online parameter estimation.
The system nonlinearities in MEMS gyroscope model have been described in [16][17][18].Since there are system nonlinearities in MEMS gyroscope, it is necessary to use robust adaptive fuzzy controller to MEMS gyroscope and utilize T-S fuzzy model to represent the system nonlinearities.
Systematic stability analysis and controller design of the adaptive fuzzy controller using T-S fuzzy model for MEMS gyroscope have not been investigated before.The advantage of the proposed adaptive T-S fuzzy controller over other controllers is that it can represent system nonlinearities using T-S fuzzy model in the aspect of robust design.Thus, it can overcome the impacts on output tracking error that are caused by model uncertainties and external disturbances.The proposed T-S modeling method can provide a possibility for developing a systematic analysis and design method for complex nonlinear control systems, thus improving the tracking and compensation performance.Thus it is necessary to adopt the adaptive fuzzy control scheme to approximate the nonlinear system and compensate model uncertainties and external disturbances in the control of MEMS gyroscope using T-S fuzzy model.
In this paper, the Lyapunov-based robust adaptive fuzzy control strategy is applied to the tracking control of MEMS gyroscope using T-S fuzzy model.The paper integrates adaptive control and the nonlinear approximation of fuzzy control with T-S fuzzy model.The proposed adaptive fuzzy T-S controller can guarantee the asymptotic stability of the closed loop system and improve the robustness of control system in the presence of model uncertainties and external disturbances.The proposed controller has the following characteristics and contributions.
(1) Since the reference model is marginally stable, the reference model is required to be revised so that the local linear state feedback controller can be designed for each T-S fuzzy submodel based on PDC.The partial parameters of the reference control matrix are changed and then the reference input is changed accordingly to guarantee that the changed reference model is equivalent to previous one.
(2) To improve the performance of the control system, the corresponding improvement is made to the adaptive law.The new adaptive law can be chosen to be the previous adaptive law plus a robust term to guarantee that the derivative of the Lyapunov function is negative rather than nonpositive. (

Dynamics of MEMS Gyroscope
Assume that the gyroscope is moving with a constant linear speed; the gyroscope is rotating at a constant angular velocity; the centrifugal forces are assumed negligible; the gyroscope undergoes rotations along -axis as shown in Figure 1.
Referring to [4,16,17], the dynamics equations of gyroscope system are as follows: where  is the mass of proof mass.Dividing the equation by the reference mass, and because of the nondimensional time  * =  0 , dividing both sides of equation by reference frequency  2 0 and reference length  0 , and rewriting the dynamics in vector forms result in where Define new parameters as follows: For the convenience of notation, ignoring the superscript yields the final form of the nondimensional equation of motion for the -axis gyroscope

Adaptive Fuzzy Control Based on PDC
The MIMO T-S fuzzy model of the MEMS gyroscope, which is composed of  rules, is established based on the nonlinear model of MEMS gyroscope.Use the fuzzy implications and the fuzzy reasoning methods suggested by Takagi and Sugeno [19] to express a real plant model; the T-S fuzzy model uses fuzzy implication of the following form: The defuzzification fuzzy dynamic system model can be expressed using center-average defuzzifier, product inference, and singleton fuzzifier where 1 (),  2 (),  3 ( ẋ ), and  4 ( ẏ ) are membership function values of the fuzzy variable , , ẋ , and ẏ with respect to fuzzy set  1 ,  2 ,  3 , and  4 , respectively.
Since the control target for MEMS gyroscope is to maintain the proof mass to oscillate in the  and  direction at given frequency and amplitude,  =   sin(  ),  =   sin(  ), generally the reference model can be defined as q  =     , where Since the reference model is nonasymptotically stable, the nonlinear T-S fuzzy model cannot be asymptotically stable.
In order to design local linear state feedback controller for each T-S fuzzy submodel based on PDC, the reference model is adjusted to be q  =     +   , where Remark 1. Substituting   ,   ,   ,  into q  yields q  ; we can get that the changed reference model q  =     +    is equivalent to previous one q  =     .According to PDC [14] The controller output can be expressed using center-average defuzzifier, product inference, and singleton fuzzifier where Substituting the controller force (12) into the fuzzy system (7) yields the desired model

Parameter Estimation
The block diagram of the adaptive fuzzy control using T-S fuzzy model is shown as in Figure 2. Taking the parameter uncertainty into account, then the parameter estimation is applied to the adaptive fuzzy control.The adaptive law can guarantee the asymptotic convergence of the error between the plant model state and the estimation model state and make the closed loop system of fuzzy controller and estimation model be a desired linear model and, consequently, the plant model state can follow the state of the desired linear model.The controller output is implemented in the nonlinear model also to prove the correctness of the T-S model and the feasibility of the proposed control scheme on the nonlinear model of MEMS gyroscope.
With unknown parameters matrix   , the controller changes to where is the estimate of   .By considering the plant parameterization, (7) can be rewritten as where   is an arbitrary stable matrix.Define the estimation mode as the following formula: The estimation model (18) can be the same one as by adopting the control input ( 15) The estimation error () = () − q () meets ( 19) and ( 20) e NON q dx = A x sin  x t) q dy = A y sin  y t) r x = A x  x cos r y = A y  y cos where () actually is the tracking error between the plant model ( 7) and the estimation model (18), Remark 2. The estimation error () can be thought of as the tracking error  T-S between the plant model (7) and the desired linear model (14) because () = () − q () and  T-S () = () −   () have the same control matrix, while the tracking error  NON between the reference model ( 14) and the nonlinear model ( 5) is used to prove the correctness of the T-S model and the feasibility of the proposed controller on the nonlinear model of gyroscope.Define a Lyapunov function candidate as where  meet     +   = −.The derivative of  with respect to time becomes Substituting ( 20), ( 21) into the derivative of  yields where The adaptive law can be chosen as where the sgn function can be defined as ( () ≥ 0 and V() ≤ 0 imply the boundedness of () and α (), the control is bounded for all time, (21) implies ė () is also bounded, and inequality (27) implies () ∈  2 .Then, with () ∈  2 ∩  ∞ and ė () ∈  ∞ , according to Barbalat's lemma [20], the tracking error () asymptotically converges to zero.

Simulation Analysis
In this section, we will evaluate the proposed adaptive fuzzy control using T-S model approach on the lumped MEMS gyroscope sensor model.Parameters of the MEMS gyroscope sensor are as follows: Since the general displacement range of the MEMS gyroscope sensor in each axis is submicrometer level, it is reasonable to choose 1 m as the reference length  0 .Given that the usual natural frequency of each axle of a vibratory MEMS gyroscope sensor is in the kHz range,  0 is chosen as 1 kHz.The unknown angular velocity is assumed Ω  = 5.0 rad/s.The desired motion trajectories are   =   sin(  ),   =   sin(  ), where   = 1,   = 1.2,   = 6.71 kHz, and   = 5.11 kHz.
The plant parameters are adjusted online by adaptive law ( 24 ] cannot adjust each parameter since partial parameters are zero which is used as adaptive gain in (24), so   is chosen as   In this simulation, it is assumed that the physical parameters in the T-S fuzzy model are not known exactly.Hence, the Time (s) Time (s) Time (s) Time (s) Time (s)    4, 5, and 6 we can see each parameter converges to its true value asymptotically.
Figure 7 depicts the tracking error of and -axis between the reference model and T-S model.It can be observed from Figure 7 that the position of  and  in the T-S model can track the position of reference model in very short time and tracking errors converge to zero asymptotically.The tracking error  T-S converges to zero asymptotically rather than shocks near zero because the new adaptive law is chosen to be the previous adaptive law   (  ()/ ∑ 9 =1   ()) [  1   2 ] ()  () plus a robust term  sgn(α  ) to guarantee that the derivative of the Lyapunov function is negative rather than nonpositive.Figure 8 plots the tracking error of and -axis between the reference model and the nonlinear model.We can notice that the performance of the tracking errors in Figure 8 is worse than that in Figure 7.
The tracking error  T-S shocks near zero because the controller is designed based on the T-S model rather than the NON model.From Figures 7 and 8, we can see the validity of the adaptive fuzzy control with parameter estimation scheme on the T-S model and the feasibility of the proposed controller on the nonlinear model of gyroscope.Then it can be concluded that the MEMS gyroscope can maintain the proof mass oscillating in the  and  direction at given frequency and amplitude by using adaptive T-S fuzzy controller.The proposed T-S modeling method can provide a possibility for developing a systematic analysis and design method for complex nonlinear control systems, which can approximate the nonlinear system and compensate model uncertainties and external disturbances.It can be observed from Figure 9 that the controller input of the adaptive fuzzy controller is stable.

Conclusions
A T-S fuzzy model based adaptive controller for angular velocity sensor is presented in this paper.An adaptive T-S fuzzy compensator is used to approximate the model uncertainties and external disturbances.The output of the fuzzy controller is used as compensator to reduce the effects of the system nonlinearities.The proposed new adaptive law can guarantee that the derivative of the Lyapunov function is negative rather than nonpositive.The proposed estimator for the existing fuzzy state feedback controller can achieve a good robust performance against parameter uncertainties.Simulation studies are implemented to verify the effectiveness of the proposed adaptive fuzzy control and the correctness of the T-S fuzzy model.However, experimental demonstration should be investigated to verify the validity of the proposed approach in the next research step.

Figure 2 :
Figure 2: The block diagram of the adaptive fuzzy control using T-S fuzzy model.

Figure 4 :
Figure 4: The change of plant parameters in  2 .

Figure 5 :
Figure 5: The change of plant parameters in  5 .

Figure 6 :
Figure 6: The change of plant parameters in  7 .

Figure 7 :
Figure 7: The tracking error  T-S between the reference model and T-S model.

Table 1 :Figure 8 :
Figure 8: The tracking error  NON between the reference model and nonlinear model.

Figure 9 :
Figure 9: Control input with the proposed controller.
Fabrication imperfections contribute mainly to the asymmetric spring term   , and asymmetric damping terms   ,   , and   are damping terms;   ,   are linear spring terms;   3 ,   3 are nonlinear spring terms, Ω *  is angular velocity;   ,   are the control forces.

Table 1 .
The initial value   = 0.9 *  *  .The variations of each parameter in  2 ,  5 , and  7 are shown in Figures4, 5, and 6.Here only parts of parameters are shown in table for examples.In Figures