Professional Documents
Culture Documents
System Dynamics and Adaptive Control of MEMS Gyroscope Sensor PDF
System Dynamics and Adaptive Control of MEMS Gyroscope Sensor PDF
Abstract: This paper presents an adaptive control approach for Micro-Electro-Mechanical Systems
(MEMS) z-axis gyroscope sensor. The dynamical model of MEMS gyroscope sensor is developed and
established . The proposed adaptive control approaches can estimate the angular velocity and the
damping and stiffness coefficients including the coupling terms due to the fabrication imperfection. The
stability of the closed-loop systems are established with the proposed adaptive control strategies.
Numerical simulations are investigated to verify the effectiveness of the proposed control schemes.
Keywords: Adaptive control, sliding mode control, MEMS gyroscope.
Fig. 1. Inertial frame and rotating frame where a A and a B are the accelerations with respect to the
d2x d2y d2z
In the Fig. 1, rA is position vector of an arbitrary point A as inertial frame, a A = i + j + k is the acceleration
B dt 2 dt2 dt2
measured against the axes of the inertial frame. r A is an
B vector of an arbitrary point A as measured against the axes
arbitrary point A relative to the origin of the rotating axes , of the rotating system.
rB is position vector of the origin of the rotating frame The acceleration of A relative to B is therefore made up of
four terms - the acceleration measured against the rotating
relative to the origin of the inertial frame B . Their relation
axes and three components that result from the rotation of the
can be expressed as
axes, and are thus invisible to the observer in the rotating
r A = rB + rA frame. These are the Euler (tangential), Centripetal and
B
(1)
= rB + x i + y j + z k . Coriolis accelerations respectively.
Multiplying (6) by mass m gives
The velocity vector of an arbitrary point A as measured
dΩ z
against the axes of the inertial frame can be derived as ma A = ma B + ma A + 2m Ω z × v A + m × r A
dx dy dz di dj dk B B dt B (7)
vA = vB + i + j+ k +x + y +z . (2)
dt dt dt dt dt dt + mΩ z × ( Ω z × r A )
B
di dj dk
Since = Ωz × i , = Ω z× j , = Ω z × k , substituting where 2m Ω z × v A is the Coriolis force and
dt dt dt B
where v A and v B are the velocities with respect to the The Coriolis force acting on the proof mass along y direction
is derived as
dx dy dz
inertial frame, v A = i+ j + k is the relative Fcoriolis − y = 2mΩ z k × x&i = 2mΩ z x&j . (9)
B dt dt dt
velocity vector of an arbitrary point A as measured against By using the property of k × (k × i ) = −i , the Centripetal
the axes of the rotating system. force acting on the proof mass along x direction can be
The velocity of A relative to B is therefore made up of two derived as
Fcentripetal − x = mΩ z k × (Ω z k × xi ) = −mΩ z xi .
2
terms - the velocity measured against the rotating axes and a (10)
component that results from the rotation of the axes, and is
thus invisible to the observer in the rotating frame.
3552
18th IFAC World Congress (IFAC'11)
Milano (Italy) August 28 - September 2, 2011
m where K m = diag w1 w2 . { 2 2
}
Proof Mass Similar to (19), the reference model can be written as
d xx d xx x 0 1 0 0
− w 2 0 0 0
X& m = 1 X m ≡ Am X m (22)
k yy d yy 0 0 0 1
2
0 0 − w2 0
Fig. 2. A simple model of a MEMS Z axis gyroscope where Am is a known constant matrix.
We make the following assumptions.
Dividing (12) and (13) by the reference mass and rewriting
Assumption. There exists a constant matrix K * such that the
the gyroscope dynamics in vector forms result in T
D K u following matching condition A + BK * = Am can always be
q&& + q& + a q = − 2 Ωq& (14)
m m m satisfied.
ux 0 −Ωz d xx d xy The control target for MEMS gyroscope is (i) to design an
x
where q = , u = , Ω = , D= , adaptive controller so that the trajectory of X can track the
y uy Ωz 0 d xy d yy state of reference model X m ; (ii) to estimate the angular
k xx k xy velocity of MEMS gyroscope and all unknown gyroscope
Ka = . parameters.
k xy k yy
Using non-dimensional time t ∗ = w0t , and dividing both
3. ADAPTIVE CONTROL DESIGN
sides of (14) by w02 and reference length q0 give the final
form of the non-dimensional equation of motion as In this section an adaptive controller is proposed to
identify the angular velocity and all unknown gyroscope
q&& D q& K q u Ω q&
+ + 2
= 2
−2 . (15) parameters. The block diagram is shown in Fig. 3. In the
q0 mw0 q0 mw0 q0 mw0 q0 w0 q0 adaptive control design, we consider (19) as the system
Defining a set of new parameters as follows: model.
3553
18th IFAC World Congress (IFAC'11)
Milano (Italy) August 28 - September 2, 2011
3554
18th IFAC World Congress (IFAC'11)
Milano (Italy) August 28 - September 2, 2011
2
controller parameters. It is shown that the estimates of
Control Signal u1
angular velocity and controller parameters converge to their 0
Control Signal u2
in the adaptive control derivation. 10000
5000
Simulations demonstrate that with the control laws (25),
and the parameter adaptation laws (30), if the gyroscope is 0
controlled to follow the mode-unmatched reference model,
-5000
the persistent excitation condition is satisfied, i.e. w1 ≠ w2 , 0 10 20 30 40 50 60 70 80 90 100
Time(Second)
and all unknown gyroscope parameters, including the angular
velocity converge to their true values, and tracking error is
Fig.6. Adaptive control input
going to zero asymptotically as time go on.
-3
x 10
2
0 k11 1540
1535
e1
-2 1530
0 10 20 30 40 50 60 70 80 90 100
Time(Second)
-4 50
0 10 20 30 40 50 60 70 80 90 100
k12
0
Time(Second)
-3 -50
x 10 0 10 20 30 40 50 60 70 80 90 100
6
Time(Second)
4 100
k13
90
e3
2
80
0 10 20 30 40 50 60 70 80 90 100
0 Time(Second)
20
-2
0 10 20 30 40 50 60 70 80 90 100
k14
0
Time(Second)
-20
Fig.4. The tracking error using adaptive control 0 10 20 30 40 50 60 70 80 90 100
Time(Second)
100
k21
90
8
80
0 10 20 30 40 50 60 70 80 90 100
Time(Second)
6 50
k22
0
4
-50
0 10 20 30 40 50 60 70 80 90 100
2 Time(Second)
Angular Rate
1380
k23
0 1360
1340
0 10 20 30 40 50 60 70 80 90 100
-2
Time(Second)
100
-4
k24
0
-6
-100
0 10 20 30 40 50 60 70 80 90 100
-8 Time(Second)
0 10 20 30 40 50 60 70 80 90 100
Time(Second)
3555
18th IFAC World Congress (IFAC'11)
Milano (Italy) August 28 - September 2, 2011
5. CONCLUSIONS Raman, J., Cretu, E., Rombouts, P., and Weyten, L. (2009).
A closed-loop digitally controlled MEMS gyroscope
This paper investigates the design of adaptive control for
with unconstrained sigma-delta force-feedback, IEEE
MEMS gyroscope. The dynamics model of the MEMS
Sensors Journal, 9(3), pp. 297-305.
gyroscope is developed and nondimensionized. Novel
Sam, Y. J., Osman, H. and Ghani, M. R. (2004). A class of
adaptive controller is proposed and stability condition is
proportional- integral sliding mode control with
established. Simulation results demonstrate that the
application to active suspension system, Systems &
effectiveness of the proposed adaptive control techniques in
Control Letters, 51(3/4), pp. 217–224.
identifying the gyroscope parameters and angular velocity.
Sung, S., Sung, W., Kim, C., Yun, S., and Lee,Y. (2009).
On the mode-matched control of MEMS vibratory
gyroscope via phase-domain analysis and design,
ACKNOWLEDGMENTS IEEE/ASME Transactions on Mechatronics, 14(4),
pp.446-455.
This work is partially supported by National Science Tsai, N., and Sue, C. (2010). Integrated model reference
Foundation of China under Grant No. 61074056, The Natural adaptive control and time-varying angular rate
Science Foundation of Jiangsu Province under Grant estimation for micro-machined gyroscopes,
No.BK2010201. The authors thank to the anonymous International Journal of Control, 83(2), pp. 246-256.
reviewers for useful comments that improved the quality of
Utkin, V. I. Ä1977Å.Variable structure systems with sliding
the manuscript.
modes, IEEE Trans. on Automatic Control, 22, pp.
212-222 .
REFERENCES Zheng, Q., Dong, L., Lee, D., and Gao, Z.(2009). Active
disturbance rejection control for MEMS gyroscopes,
Antonello ,R., Oboe, R. , Prandi, L., and Biganzoli, F. IEEE Transactions on Control System Technology,17(6),
(2009).Automatic mode matching in MEMS vibrating pp. 1432 -1438.
gyroscopes using extremum-seeking control, IEEE
Transactions on Industrial Electronics, 56(10), pp.3880-
3891.
Batur, C. and Sreeramreddy, T.(2006). Sliding mode control
of a simulated MEMS gyroscope, ISA Transactions,
45(1), pp.99-108 .
Chou, C., and Cheng , C.(2003). A decentralized model
reference adaptive variable structure controller for large-
scale time-varying delay systems, IEEE Transactions on
Automatic Control, 48(7), pp. 1213-1217.
Fei, J. and Batur, C. (2009). Robust adaptive control for a
MEMS vibratory gyroscope, International Journal of
Advanced Manufacturing Technology, 42(3), pp. 293-
300.
Fei, J. and Batur, C. (2009). A novel adaptive sliding mode
control for MEMS gyroscope È ISA Transactions
48(1), pp. 73-78.
Feng, Z., and Fan, M. (2007). Adaptive input estimation
methods for improving the bandwidth of
microgyroscopes, IEEE Sensors Journal, 7(4), pp.562-
567.
Ioannou, P. and Sun, J. (1996). Robust Adaptive Control.
Prentice-Hall.
Leland, R. (2006).Adaptive control of a MEMS gyroscope
using Lyapunov methods. IEEE Transactions on
Control Systems Technology, 14, pp.278–283.
Park, S., Horowitz, R., Hong, S., and Nam, Y. Nam. (2007).
Trajectory-switching algorithm for a MEMS gyroscope,
IEEE Transactions on Instrumentation and
Measurement, 56(60), pp.2561-2569.
Park, S., and Horowitz, R. (2004). New adaptive mode of
operation for MEMS gyroscopes, ASME Transaction
Dynamic Systems, Measurement and Control, 126,
pp.800-810.
3556