1. Introduction
As one kind of inertial sensors, gyroscopes are used in application areas where there exist particular requirements for angular velocities measurement and MEMS gyroscopes have attracted increasing attention for the advantages of low cost, easy installation and so on. Due to above mentioned prominent features, MEMS gyroscopes have been widely installed in cell phones, navigation devices, self-balance platforms and other application aspects. Generally speaking, the principle of vibrating gyroscopes is based on the Coriolis phenomenon where a detecting mass is driven into a stable oscillatory motion along the driving axis, Coriolis force occurs along the sense axis when some angular velocity is applied to the gyroscope. However, gyroscope performances are often degraded by manufacturing errors (mainly contribute to aspects of parameter deviation and asymmetric structure) and external disturbances, which exist in manufacturing and measuring environments. As a result, aiming at improving gyroscope oscillation performance as well as robustness to disturbances, advanced control methods such as sliding mode control (SMC), adaptive control (AC) are practical and feasible choices in the control of gyroscopes.
It is known that there are many factors that may hinder the angular velocity measurement such as asymmetrical structure, temperature [
1,
2,
3,
4], humidity in packing environment, and other disturbances. Great efforts have been devoted to improve system performances and robustness by suppressing parameter uncertainties and external disturbances [
5,
6,
7,
8,
9]. Various control methods are adopted to stabilize gyroscope systems and improve system performances. In [
5], Mehran used an extended state observer and presented a disturbance rejection-based controller for MEMS gyroscopes. As one kind of advanced control scheme with extraordinary strong robustness [
10,
11,
12,
13], SMC can also be used to control gyroscope dynamics and the method has been adopted in various implementation occasions for its outstanding features such as easy implementation, insensitive to parameter variation, strong robustness and so on. In [
12], Utkin introduced the concept of sliding mode control method where design and analysis for sliding mode systems are investigated. Although SMC is a good tool for control problems in the presence of disturbance and uncertain parameters, SMC can achieve excellent control performance on the basis that there exist a switching term varying with error dynamics which may cause high frequency chattering in control forces. To overcome the drawback of SMC, great efforts have been devoted to the investigation of SMC method, ASMC, dynamic sliding mode control, super-twisting algorithm are gradually introduced and adopted in many areas.
AC technique is one effective method to solve system parameter variation problems and it is often integrated with SMC to alleviate chattering in the face of different kinds of disturbances. The basic principle of AC strategy is that controller parameters can vary automatically according to different system parameters and different system dynamics. As a result, it is natural to combine AC with SMC method for system performance improvement in the presence of parameter deviation. In [
14], Fei and Batur proposed a robust sliding mode controller for gyroscopes where all parameters can be estimated by adaptive laws. Fei and Yan [
15,
16] further proposed terminal sliding mode controller for gyroscopes where finite time error convergence can be achieved.
Although the control methods [
14,
15,
16] mentioned above can accomplish trajectory tracking under parameter variation and other disturbances, transient performance indexes especially maximum overshot and undershot [
15] and error convergence rate are not fully studied. However, for the fact that MEMS gyroscopes are very small while its structure is quite complex and precise, control of dynamics of gyroscope oscillation are of great importance and deserve more focus on the design of corresponding control strategies. For example, big overshot or undershot may cause detecting capacity combs to collide resulting in damage to measure chips. At the same time, error convergence rates are also very important in measurement meters, if it takes a very long time for the tracking errors to converge (in other words a very long settling time), it may lead to a very long measuring time and it is not likely to choose measuring meters which need a long time for measure values to stabilize in practical situations. However, very little attention is paid to these important performances.
To improve the control performance of the systems, terminal sliding mode control, non-quadratic Lyapunov function [
17,
18] can be utilized in the design of control systems. Meanwhile, prescribed performance control (PPC) method [
19,
20,
21] is an advanced control method which ensures that system tracking error will not go beyond a predefined error bound and the error dynamics converge faster than the error bound. In [
20], Bechlioulis and Rovithakis introduced a kind of PPC method for nonlinear MIMO systems where the “constrained” error dynamic system is stabilized using the proposed control method with the “unconstrained” error signals. For the characteristic of PPC that the method can impose some specified error bound on system error dynamics to achieve a favorable performance. PPC technique has been applied in diverse occasions including space vehicle altitude control [
19,
22,
23] and so on [
24,
25]. In [
26], Lu and Fei adopted PPC method for MEMS gyroscope control, and the method can successfully drive the detecting mass into a desired oscillation. However, the predefined error bound is treated as a slow time varying function and it shall be further investigated how to accomplish the trajectory tracking objective without the assumption [
27].
Motivated by the above mentioned work, this paper aims to systematically study the MEMS gyroscope trajectory tracking via adaptive PPC approach. The main contribution of this paper can be concluded as follows:
The proposed adaptive prescribed performance sliding mode control (APPSMC) utilizes a transformed error in the design of sliding mode control (SMC) surface where a performance bound (PB) function regarding system tracking error is proposed together with an error transformation function to connect the origin system tracking error with the transformed equivalent error.
The MEMS gyroscope tracking error can converge to the 0 and remaining in a predefined PB (both transient state and steady state) under the proposed APPSMC. It is worth pointing out that above mentioned gyroscope control papers cannot guarantee tracking error to be within a specific bound while the gyroscope tracking error in this paper will not go beyond the proposed error bound.
The propose control method can accomplish trajectory tracking with information of the nominal values of the system where some adaptive laws are derived in the Lyapunov stability framework where gains for adaptive laws can be calculated according to the calculation method introduced in the paper.
This paper is organized as follows: the gyroscope dynamics are introduced in
Section 2. In
Section 3, design and stability proof for the Z-axis gyroscope using APPSMC is investigated.
Section 4 provides simulation results and
Section 5 gives the conclusions.
2. Dynamics of MEMS Gyroscopes
The schematic structure of a gyroscope model is described in
Figure 1. As shown in
Figure 1, the vibrating gyroscope contains a proof mass, spring beams, and dampers. The proof mass is driven by electrostatic actuators and it is constrained only to move in the X–O–Y plane where states including position and velocity information of the proof mass can be acquired detecting capacity combs. Some fixed angular velocity is applied to the gyroscope along the Z axis.
Gyroscope dynamics [
28,
29] can be described in the following form:
is the proof mass weight;
and are the displacements of the mass; and
and are the coefficients for springs and dampers in the X and Y directions.
and are coefficients of the coupling terms which are mainly caused by the asymmetric structure due to limits of manufacture technology.
is the angular velocity and and represent the control forces in the X and Y direction.
We can get the motion dynamics in non-dimensional form through dividing both sides of (1) by the resonance frequency
, reference length
and reference mass
.
where
,
,
,
,
,
,
,
,
,
,
,
,
,
, and
.
(2) is rewritten in vector form as:
where
,
,
,
, and
Due to manufacture errors and environment changes, actual values for springs, dampers, and their nominal values are not exactly the same. Considering these effects, we modified system dynamics by adding extra terms concerning parameter deviation and external disturbance and the new motion equation in the described in the following form:
where
is the lumped unknown disturbances vector including unknown system dynamics (caused by parametric deviation) and external disturbance. The lumped disturbance is further described such that
where
,
, and
denote parameter uncertainties of
,
, and
, respectively, and we allow 10% parameter variations for the spring and damping coefficients with respect to their nominal values such that
,
, and
.
is external disturbance vector caused by temperature change, humidity change, shock, and so on.
State space form of gyroscope dynamics is:
where system states
and
are the displacement and velocity vectors of the detect mass and they are denoted as
and
.
represents the lumped disturbance vector.
Assumption 1 regarding is made for further discussion.
Assumption 1. The lumped disturbance is bounded [12] such that . , are lumped disturbances in the X and Y axis, respectively, and and are disturbance bounds in each direction. The control objective for MEMS gyroscopes is: 1) to propose an adaptive controller so that the proof mass can be driven into oscillation motion at given amplitudes and frequencies in the driving and sensing axis, or in other words, to reach the target that the gyroscope state can track a reference trajectory and the tracking error satisfies specific prescribed performance requirement and 2) controller parameters can be tuned by adaptive laws.
3. APPSMC for MEMS Gyroscopes
An APPSMC is introduced to accomplish trajectory tracking where several adaptive laws are derived to adjust controller parameters. The stability of the control system is guaranteed according to Lyapunov stability theory. In the design procedure of the PPC method in this section, an error transformation function is introduced to transform the origin tracking error into an equivalent unconstrained one and the transformed error is used in the design of adaptive sliding mode controller with prescribe performance.
According to the theory of PPC scheme in [
20,
21], error dynamics shall always stay in some specified error bound described by a PB function and the error convergence rate is no less than the performance function. Generally speaking, any smooth decreasing function can be chosen as an error bound function. As can be seen from [
20,
21] that the performance bound function is chosen as a decreasing function. Prescribed performance can be achieved by transforming the original tracking error into an unconstrained equivalent error with appropriate original error bound and steady state error bound. In the paper, we adopted the prescribed performance control method in the control of gyroscopes to provide transient tracking performance of the gyroscopes. Relative articles have been cited in the reference.
In this section, a decreasing function described by Equation (6) is adopted as an error bound function.
According to the theory of prescribed performance control (PPC) [
20,
21],
is a non-zero positive constant and choices for
shall comply with the principle that the initial tracking error is less than
.
is also a positive constant and it is the value of the PB imposed on error dynamics at the steady state.
is the Euler number and the term determines the convergence speed of PB function . It can be found from that is the dominant parameter which is chosen as a positive constant. Different choices of can result in different PB function with different convergence speed.
If gyroscope tracking errors satisfy
, prescribed performance is guaranteed. A new performance index is introduced construct connection between the origin tracking error and the PB, given in the form:
We can easily get the range of (7) such that
if prescribed performance is achieved. A hyperbolic tangent function is chosen to transform the constrained error index
into an equivalent unconstrained one. The error transformation equation is expressed as:
where
is the adjust parameter for the transformation function chosen to be a positive constant.
is the derived “equivalent” error which is used to compose the sliding manifold afterwards.
Figure 2 depicts the hyperbolic tangent function.
Lemma 1. If the equivalent error in (8) converges 0, the origin error in (8) will also converge to 0.
Proof. From the definition of the hyperbolic tangent function defined in (8) and the graphic depicting the hyperbolic tangent function in (8), we can easily get the conclusion that: converges to 0 with converging to 0.
Equivalent error
can be derived by solving the inverse function of
, given in the form:
where
represents the inverse function of
.
In the following parts, , , and are denoted as , , and for simplicity.
Consider (5) as the system dynamics, system tracking error is defined as:
where
is the reference trajectory, given in the form
.
The derivative of the tracking error is:
Conventionally, sliding mode control method uses system error and its derivative to form a sliding mode manifold. In APPSMC, the new derived error will be used in the design of the prescribed performance sliding mode manifold.
Consider a linear sliding manifold given in the form:
where
is an adjustable parameter of the manifold chosen to be a diagonal matrix with its main diagonal elements being positive constants.
Differentiating (12) leads to:
can be derived according to (9) and
takes the form:
Differentiating (14) gives:
Differentiating (15) leads to:
where
It can be proved that and are positive diagonal matrices for the fact that and are positive constants and .
For simplicity, equation (16) is rewritten in vector form:
where
,
,
, and
.
Differentiating (8) with respect to time gives first and second order derivative of
.
where:
Equation (19) is rewritten in vector form as:
where
,
,
, and
Substitute (20) into (17) gives:
Substitute (21) into (13) leads to:
Substitute system dynamics in (4) into (22), it reveals that:
Equivalent control force can be derived by ignoring the lumped error
and setting
:
The actual sliding mode control force is designed in the form:
where the switching control force
is designed in the form:
where
is the gain of the switching term. □
Theorem 1. If the control force in (25) is applied to the MEMS system with robust gain in (26) larger than the lumped disturbance bound, system tracking error will asymptotically converge to 0.
Proof. Choose a Lyapunov candidate in the form:
Differentiating (27) with respect to time leads to:
Substitute the control force in (25) into (28) leads to:
It can be inferred from Assumption 1 that if the robust gain
is set such that
, together with the fact that
and
are positive diagonal matrices, the derivative of the Lyapunov function is non-positive definite in the following form.
It can be seen from the designed control force (24) that the control force contains three different system parameter matrices which are actually unknown. Thus, we actually cannot carried out the control force directly. AC can be used in the paper to tune control force parameters and the control force in (25) is modified in the following form where three adaptive laws are given in (32)–(34).
where
,
, and
are set to replace the corresponding parameters and they are the estimates for
,
, and
,respectively.
Adaptive laws for
,
, and
are set in the following form. □
Theorem 2. if the control force in (31) in applied to the MEMS system, adaptive laws (32)–(34) are incorporated to online tune control force parameters, system tracking error will asymptotically converge to 0. Besides, according to parameter identification theory [30], all system parameters can be correctly estimated if the persistent excitation condition is satisfied. Figure 3 shows the block diagram of the entire APPSMC system.
Proof. Select a Lyapunov candidate in the form:
where the function contains sliding surface and parameter estimation error.
Parameter estimation errors are more specifically described in the following form:
, , and are positive constants which can be viewed as fix gains for adaptive laws.
Differentiating right hand and left hand of (35) and substituting system dynamic in (4) into it yields:
The last three terms in (36) are denoted as for clarity.
Substituting control force in (31) into (36) yields:
Recover
back to its original form, (37) can be rewritten as:
According to the property of matrix trace, (38) can be rewritten in the form:
Substituting adaptive laws (32), (33), (34) into (39) leads to:
According to Assumption 1 together with the fact that , are positive diagonal matrices, can be proved to be semi positive definite with .
is negative definite i.e.,
implies that
,
,
, and
are all bounded. Integrating both sides of (40) leads to
. For the fact that
is bounded,
is bounded and non-increasing, we can obtain
. Besides, since
is also bounded, therefore, we can prove that
will asymptotically converge to zero, i.e.,
by Barbalart lemma [
14]. If the sliding manifold
, the equivalent error
will converge to 0 with the sliding surface (12) being a Hurwitz polynomial. Furthermore, we can infer from Lemma 1 that the origin tracking error will converge to 0 with the equivalent error converging to 0. □
Remark 1. In this paper, a prescribed performance is proposed for the control of MEMS gyroscopes. For further improvement of gyroscope oscillation motion performance, design of the control of gyroscopes can be investigated using non-quadratic Lyapunov function [
17,
18].
4. Simulation Study
Numerical simulations are conducted on a Z-axis gyroscope model using Matlab/Simulink environment to evaluate the effect of the proposed APPSMC method.
,
, and
are system parameters matrices and actual gyroscope parameters (elements of
,
, and
) are listed in
Table 1.
And in the simulation study, we compared control performances of adaptive sliding mode control, sliding mode control, and adaptive prescribed performance control. Table of used acronyms and corresponding full names are provided in
Table 2.
To verify the robustness of the APPSMC, parameter deviations and random signal disturbance are set in the control system where there exist 10% parameter deviation between actual gyroscope parameters and the origin values (nominal values) in APPSMC such that
,
, and
. Parameters for the PPB and parameters for the proposed controller including robust gain and gains for adaptive laws are listed in
Table 3.
Figure 4 and
Figure 5 depict trajectory tracking performances using SMC1, SMC2, ASMC1, and ASMC2. Parameters of the controllers above mentioned are listed in
Table 3. In
Figure 4 and
Figure 5, red and green dotted line depict actual MEMS trajectory using SMC2 and SMC1, while yellow and purple dotted lines depict system trajectory using ASMC1 and ASMC2. Reference trajectory are depicted by a blue solid line. It is obvious in
Figure 4 and
Figure 5 that system trajectory using SMC1 (green) and ASMC1 (yellow) can hardly track the reference trajectory while system trajectory using SMC2 and ASMC2 can achieve trajectory tracking. Furthermore, blue, red and purple line almost overlap with each other after time = 15 s.
Figure 6 and
Figure 7 depict system tracking error performances in X and Y axis. According to the analysis of system tracking performances in
Figure 4 and
Figure 5, it can be found from
Figure 6 and
Figure 7 that system tracking error using SMC2 (red) and ASMC2 (purple) can converge to 0, which means the mass proof is successfully driven into the desired oscillation mode (fixed amplitude and frequency) by SMC2 and ASMC2. Green and yellow line depict system tracking error using SMC1 and ASMC1 where tracking error does not converge to 0 while it does not diverge to infinity. By connecting
Table 3 and
Figure 4,
Figure 5,
Figure 6 and
Figure 7 it can be concluded that, due to parameter uncertainty and external disturbance, SMC1 cannot accomplish trajectory tracking with a small robust gain while tracking error using SMC2 can converge to 0 with a big robust gain. Comparisons between ASMC1 and ASMC2 shows that proper gain in adaptive laws can result in good tracking error performance.
Choosing SMC2 and ASMC2 for comparison, system tracking performance using APPSMC is provided in
Figure 8 and
Figure 9. It can be seen that system dynamic can track the command trajectory after several milliseconds. Furthermore, it can be found that blue, red and purple line almost overlap with each other after time = 15 ms.
Figure 10 and
Figure 11 depict trajectory tracking performances using APPSMC, SMC2, and ASMC2. Parameters of the controllers are listed in
Table 3. In
Figure 10 and
Figure 11, blue and green solid line are upper and lower bound described by performance bound function. Red dotted line, purple dotted line and black dotted line depict tracking error performance of SMC2, ASMC2, and APPSMC, respectively. It can be seen from
Figure 10 and
Figure 11 that all three control methods can achieve trajectory tracking target while only APPSMC and SMC1 can maintain tracking error to be within the performance bound. It shall be pointed out that the great tracking error performance of SMC1 is derived on the basis that all system parameters are well known. Besides, the robust gain in SMC2 is chosen to be very big and the big robust gain will result in severe chattering phenomenon. At the same time, APPSMC can still achieve desired error performance using adaptive laws to tune controller parameters even if system parameters are not exactly known and there are no severe chattering in control force for the fact that the robust gain in APPSMC is very small.
Table 4 compares system mean absolute errors and root mean square errors of APPSMC, ASMC1, ASMC2, SMC1, and SMC2. It can be concluded from
Table 4 that the proposed control method can achieve excellent tracking error performance compared with conventional ASMC. SMC2 have a better tracking error performance on the basis that all system parameters are well known. Besides, the robust gain in SMC2 is larger than the robust gain used in APPSMC and the big robust gain will result in severe chattering in control forces.
To further validate the effectiveness and robustness of the proposed control method, some low frequency noise is added to the system. It can be seen from
Figure 12 and
Figure 13 that system tracking errors in both directions remain in the performance bound. The results mean that the control system has a strong robustness in the presence of diverse disturbances.
Figure 14 and
Figure 15 depict adaptation performances of system parameters. It can be found from
Figure 14 and
Figure 15 and nominal values of system parameters in
Table 1 that initial values for system parameters and their true values are not the same at the beginning. But the estimation values for system parameters can change with the adaptive laws and parameter adaptation performances in
Figure 14 and
Figure 15 indicate that although there are some oscillation in the parameter adaptation performance, all system parameters can converge to bounded range and can almost converge to their true values by adaptive laws. As a consequence, the adaptive mechanism can greatly alleviate chattering phenomenon in the control force caused by parameter deviations.
Figure 16 depicts control forces in the X and Y direction. It can be seen from above figure that there are some slight chattering in the control forces and the chattering can be further reduced by substituting sign function in the control force with saturated function.