Abstract

Fabrication defects and perturbations affect the behavior of a vibratory MEMS gyroscope sensor, which makes it difficult to measure the rotation angular rate. This paper presents a novel adaptive approach that can identify, in an online fashion, angular rate and other system parameters. The proposed approach develops an online identifier scheme, by rewriting the dynamic model of MEMS gyroscope sensor, that can update the estimator of angular rate adaptively and converge to its true value asymptotically. The feasibility of the proposed approach is analyzed and proved by Lyapunov's direct method. Simulation results show the validity and effectiveness of the online identifier.

1. Introduction

Gyroscopes are commonly used sensors for measuring angular velocity in many areas of applications such as navigation, homing, and control stabilization. Vibratory gyroscopes are the devices that transfer energy from one axis to another axis through Coriolis forces. The conventional mode of operation drives one of the modes of the gyroscope into a known oscillatory motion and then detects the Coriolis acceleration coupling along the sense mode of vibration, which is orthogonal to the driven mode. The response of the sense mode of vibration provides information about the applied angular velocity. Fabrication imperfections result in some cross-stiffness and cross-damping effects that may hinder the measurement of angular velocity of MEMS gyroscope. The angular velocity measurement and minimization of the cross-coupling between two axes are challenging problems in vibrating gyroscopes.

Ioannou and Sun [1] and Tao [2] described the model reference adaptive control. Chou and Cheng [3] proposed an integral sliding surface and derived an adaptive law to estimate the upper bound of uncertainties. Some control algorithms have been proposed to control the MEMS gyroscope. Batur and Sreeramreddy [4] developed a sliding mode control for a MEMS gyroscope system. Leland [5] presented an adaptive force balanced controller for tuning the natural frequency of the drive axis of a vibratory gyroscope. Novel robust adaptive controllers are proposed in [6, 7] to control the vibration of MEMS gyroscope. Sung et al. [8] developed a phase-domain design approach to study the mode-matched control of MEMS vibratory gyroscope. Antonello et al. [9] used extremum-seeking control to automatically match the vibration mode in MEMS vibrating gyroscopes. Feng and Fan [10] presented an adaptive estimator-based technique to estimate the angular motion by providing the Coriolis force as the input to the adaptive estimator and to improve the bandwidth of microgyroscope. Tsai and Sue [11] proposed integrated model reference adaptive control and time-varying angular rate estimation algorithm for micromachined gyroscopes. Raman et al. [12] developed a closed-loop digitally controlled MEMS gyroscope using unconstrained sigma-delta force balanced feedback control. Park et al. [13] presented an adaptive controller for a MEMS gyroscope which drives both axes of vibration and controls the entire operation of the gyroscope.

The adaptive control of MEMS gyroscope is system identification problem. The identification is a very rich investigation subject in the last decades. The persistence of excitation is the most important problem in the system identification. There are several ways to deal with it; one is to use a sufficient number of frequencies in the reference signal. Sometimes, the use of multiestimation-type schemes with appropriate switching among the various single multiestimation schemes integrating the whole tandem has been done successfully since this guarantees directly sufficiently frequency richness/excitation persistence. Guillerna et al. [14] proposed a robustly stable multiestimation scheme for adaptive control and identification with model reduction issues. Sen and Alonso [15] presented adaptive control of time-invariant systems with discrete delays subject to multiestimation. Moreover, there are some articles devoted to identification in practical real problems. Paulraj and Sumathi [16] compared the redundant constraints identification methods in linear programming problems. Ho and Chan [17] developed hybrid differential evolution algorithm for parameter estimation of differential equation models with application to HIV dynamics. Blais [18] derived a novel least squares method for practitioners.

In this paper, a novel adaptive online identifier is designed to estimate the angular rate and system parameters. The motivation of this paper is to propose a novel series-parallel online identifier that could estimate all the system parameters using observed state and control signals. The advantage of proposed adaptive approach is that it is easy to implement in practice and it avoids the complicated algorithm derivation; therefore, it is better than other control algorithm for the vibratory MEMS gyroscope.

The paper is organized as follows. In Section 2, the dynamics of MEMS gyroscope sensor is introduced. In Section 3, the online identifier is developed to achieve the system parameters and angular rate. In Section 4, simulation results are presented to verify the design of online identifier. Conclusion is provided in Section 5.

2. Dynamics of MEMS Gyroscope

A typical MEMS vibratory gyroscope sensor configuration 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 as well as a rigid frame which is rotated along the rotation axis. Dynamics of a MEMS gyroscope sensor is derived from Newton’s law in the rotating frame.

As we known, Newton’s law in the rotating frame becomes

In (2.1), is the total applied force to the proof mass in the gyro frame, is the total physical force to the proof mass in the inertial frame, is the centrifugal force, is the Coriolis force, is the Euler force, and is the acceleration of the proof mass with respect to the gyro frame. , , and are inertial forces caused by the rotation of the gyro frame.

With the definition of 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 reduce to then where contains spring, damping, and control forces applied to the proof mass.

In a -aixs gyroscope sensor, by supposing the stiffness of spring in direction much larger than that in directions, motion of poof mass is constrained to only along the - plan as shown in Figure 1. Assuming that the measured angular velocity is almost constant over a long enough time interval, the equation of motion of a gyroscope sensor based on (2.3) is simplified as follows where and are the coordinates of the proof mass with respect to the gyro frame in a 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. The last two terms in (2.4), and , are the Coriolis forces and are used to reconstruct the unknown input angular rate . Under typical assumptions , 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 governing equation for a -axis MEMS gyroscope sensor is In (2.5), and are damping, 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 (2.5) by , , and , which are a reference mass, length, and natural resonance frequency, respectively, where is the proof mass of a gyroscope sensor, we get the form of the nondimensional equation of motion as where , , , , , . Rewrite the gyroscope sensor model (2.6) in state-space form as where From (2.8), it is obvious that all the unknown or uncertain parameters including the input angular rate are lumped in the . Then, this paper will develop a novel adaptive approach that can identify the system matrix in an online fashion.

The dynamics of MEMS gyroscope sensor described by (2.6) can be considered as a mass, spring, and damper system, which implies that is stable. With the assumption that the control inputs and are bounded, the system state vector is then also bounded. This prior knowledge will be used for the design of the online identifier.

3. The Design of Online Identifier

The objective of this section is to generate an adaptive law for identifying online by using the observed signals and . Figure 2 shows the block diagram of the online identifier.

First of all, rewrite the dynamic model (2.7) by adding and subtracting a term , where is an arbitrary stable matrix: The adaptive law for generating the estimate of is to be driven by the estimation error where is the estimated value of , that is, the state output of the identifier, by using the estimate . The state is generated by an equation that has the same form as the gyroscope sensor model but with replaced by . Deriving from the gyroscope sensor equation (3.1), the model of the online identifier is The estimation error satisfies the differential equation where Equation (3.4) indicates how the parameter error affects the estimation errors . Because is stable, zero parameter error implies that converges to zero exponentially. Indeed, is unknown and is the only measured signal that we can monitor in practice to check the successfulness of estimation. We have the following theorem to gain the objective.

Theorem 3.1. Consider the online identifier system (3.3) and with the control input . By utilizing parameter adjusting law (3.6) then the proposed adaptive identifier scheme can guarantee the following properties:(1)the identifier scheme is stable;(2), namely, asymptotic observer property;(3), namely, asymptotic preidentification property;(4), namely, asymptotic identification property if the persistent excitation condition is satisfied.

Proof. Utilizing the measured signals, we assume the adaptive law is of the form where is the function of measured signals, and is to be chosen so that the equilibrium state of the differential equation described by (3.4) and (3.7) is uniformly stable, or if possible, uniformly asymptotically stable, or, even better, exponentially stable.
Consider the following Lyapunov function candidate of the estimation error system (3.4): where denotes the trace of the matrix and is chosen as the solution of the Lyapunov equation: where , whose existence is guaranteed by the stability of .
The time derivative of along the trajectory of (3.4), (3.7) is Use the properties of trace of a matrix The obvious choice for to make negative is This adaptive law yields
Equation (3.14) implies that the equilibrium , of the respective equations is uniformly stable and , are all uniformly bounded for all ; that is, the online identifier scheme is stable. On condition that is bounded, is also bounded obtained from (3.4).
It can be proved that , using the following Barbalat's lemma.
Lemma 3.2. If is a uniformly continuous function, such that exists and is finite, then as .Corollary 3.3. If and , for some , then as .
Since where is the minimum eigenvalue of and satisfies , inequality (3.15) implies that is integrable as . Since is bounded and , it can be concluded that is bounded. Since , and are bounded, according to Barbalat’s lemma, , which, in turn, implies that . Therefore, it can be concluded that this scheme is not only an asymptotic identifier but also an asymptotic observer.

Like in other adaptive control problems, the persistent excitation condition is an important factor to estimate the angular rate correctly. From (2.7), (2.8), the dynamics of a MEMS gyroscope sensor can be considered as a fourth-order system, which implies that if the control input contains two different nonzero frequencies, then the persistency of excitation is satisfied. Then, we define where satisfy , , . Under these assumptions, the estimate converges to its true value , namely, .
In summary, if and are used, then converge to zero asymptotically. Consequently, angular rate and system parameters converge to their true values.
This completes the proof of the theorem.

Remark 3.4. In this section, we consider the design of online parameter estimators for the plant that is stable, whose states are accessible for measurement and whose input is bounded. Because no feedback is used and the plant is not disturbed by any signal other than , the stability of the plant is not an issue. The main concern, therefore, is the stability properties of the estimator or adaptive law that generates the online identifier for the unknown plant parameters. However, it should be recognized that, in more general cases where is either unstable or critically stable, the control should be designed in a closed-loop fashion to achieve closed-loop stability.

Remark 3.5. we are able to design online parameter estimation schemes that guarantee that the estimation error converges to zero as , that is, the predicted state approaches that of the plant as and the estimated parameters change more and more slowly as time increases. Because the input signal is sufficiently rich, it is sufficient to establish parameter convergence to the true parameter values. To be sufficiently rich, has to have enough frequencies to excite all the modes of the plant.

Remark 3.6. The properties of the adaptive scheme developed in this section rely on the stability of the plant (MEMS gyroscope model) and the boundedness of the plant input . Consequently, they may not be appropriate for use in connection with control problems where is the result of feedback and is, therefore, no longer guaranteed to be bounded a priori. Fortunately, online parameter estimation scheme that uses the adaptive laws with normalization does not rely on the stability of the plant and the boundedness of the plant input. In plain terms the unboundedness obstacle can be avoided by dividing and (plant states) with some normalizing signal , to obtain , belonging to space and use the normalized signal to drive the adaptive law instead of and . In this paper, this is not discussed in detail.

4. Simulation Study

In this section, we will evaluate the proposed adaptive approach on the lumped MEMS gyroscope sensor model by using MATLAB/SIMULINK. The objective of the adaptive approach is to identify the parameters including the input angular velocity correctly. Parameters of the MEMS gyroscope sensor are as follows [4]:

Since the general displacement range of the MEMS gyroscope sensor in each axis is submicrometer level, it is reasonable to choose 1  as the reference length . Given that the usual natural frequency of each of the axles of a vibratory MEMS gyroscope sensor is in the KHz range, choose the as 1 KHz. The unknown angular velocity is assumed . Then, the nondimensional values of the MEMS gyroscope sensor parameters are as follows: , , , , , , and . According to (2.8), the system matrix in this simulation example is then given by The four eigenvalues of are , and , which verify the stability of . The initial value of estimator is . and are zero initial conditions.

Given the arbitrariness of stable matrix , we choose , for the simplicity to choose the gain matrix . With , can be an arbitrary positive symmetrical matrix to ensure the positivity of matrix . Note that the choosing of should take into account the balance of the elements in . The control input forces are , and , containing two different nozero frequencies, which are sufficiently rich. The simulation results are shown in Figures 3, 4, and 5.

Figure 3 depicts the estimation errors. It is observed that the estimation errors converge to zero quickly, under the sinusoidal input of two different nonzero frequencies, which validates that the estimated states converge to the actual states asymptotically and equilibrium is uniformly asymptotically stable. Error (1), Error (2), Error (3), and Errror (4) stand for -axis position estimation error, -axis velocity estimation error, -axis position estimation error, and -axis velocity estimation error, respectively. Figure 4 obviously shows that the estimation of the angular rate reaches its actual value in finite time. The regulating time is about 10 seconds, and the overshot is approximately 49%. Simulation experiments show that the regulating time and the overshot of the angular rate estimation are a pair of contradiction. Choosing a reasonable matrix can find a compromise between them. Figure 5 shows that all of the estimates of can reach their true values in a very short time, respectively, with very small overshot.

Simulation results verify that with the online identifier model (3.3) and the parameter adaptive law (3.12), if the persistent excitation condition is satisfied, that is, two different nonzero frequencies inputs, then the estimation errors converge to zero asymptotically and all unknown parameters, including the angular velocity go to their true values quickly without large overshot.

5. Conclusion

This paper investigates the design of adaptive control for MEMS gyroscope sensor. The dynamics model of the MEMS gyroscope sensor is developed and nondimensionalized. Novel adaptive approach with online identifier is proposed, and stability condition is established. Simulation results demonstrate the effectiveness of the proposed adaptive online identifier in identifying the gyroscope sensor parameters and angular rate. We should recognize that model uncertainties and external disturbances have not been considered in the proposed online adaptive identifier yet, which should be compensated for in the real application; the next step is to incorporate the term of model uncertainties and external disturbances into the online identifier to improve the robustness of the proposed method.

Acknowledgments

This work is partially supported by the National Science Foundation of China under Grant no. 61074056 and The Natural Science Foundation of Jiangsu Province under Grant no. BK2010201. One of the authors thanks the anonymous reviewer for useful comments that improved the quality of the paper.