Huiliang Cao1,2,3, Hongsheng Li4, Zhiwei Kou5,6, Yunbo Shi7,8, Jun Tang9,10, Zongmin Ma11,12, Chong Shen13,14, Jun Liu15,16. 1. Key Laboratory of Instrumentation Science & Dynamic Measurement, Ministry of Education, North University of China, Tai Yuan 030051, China. caohuiliang@nuc.edu.cn. 2. Science and Technology on Electronic Test & Measurement Laboratory, North University of China, Tai Yuan 030051, China. caohuiliang@nuc.edu.cn. 3. School of Instrument Science and Engineering, Southeast University, Nanjing 210096, China. caohuiliang@nuc.edu.cn. 4. School of Instrument Science and Engineering, Southeast University, Nanjing 210096, China. hsli@seu.edu.cn. 5. Key Laboratory of Instrumentation Science & Dynamic Measurement, Ministry of Education, North University of China, Tai Yuan 030051, China. kouzhiwei@imut.edu.cn. 6. Science and Technology on Electronic Test & Measurement Laboratory, North University of China, Tai Yuan 030051, China. kouzhiwei@imut.edu.cn. 7. Key Laboratory of Instrumentation Science & Dynamic Measurement, Ministry of Education, North University of China, Tai Yuan 030051, China. shiyunbo@nuc.edu.cn. 8. Science and Technology on Electronic Test & Measurement Laboratory, North University of China, Tai Yuan 030051, China. shiyunbo@nuc.edu.cn. 9. Key Laboratory of Instrumentation Science & Dynamic Measurement, Ministry of Education, North University of China, Tai Yuan 030051, China. tangjun16@126.com. 10. Science and Technology on Electronic Test & Measurement Laboratory, North University of China, Tai Yuan 030051, China. tangjun16@126.com. 11. Key Laboratory of Instrumentation Science & Dynamic Measurement, Ministry of Education, North University of China, Tai Yuan 030051, China. mzmncit@163.com. 12. Science and Technology on Electronic Test & Measurement Laboratory, North University of China, Tai Yuan 030051, China. mzmncit@163.com. 13. Key Laboratory of Instrumentation Science & Dynamic Measurement, Ministry of Education, North University of China, Tai Yuan 030051, China. shenchong@nuc.edu.cn. 14. Science and Technology on Electronic Test & Measurement Laboratory, North University of China, Tai Yuan 030051, China. shenchong@nuc.edu.cn. 15. Key Laboratory of Instrumentation Science & Dynamic Measurement, Ministry of Education, North University of China, Tai Yuan 030051, China. liuj@nuc.edu.cn. 16. Science and Technology on Electronic Test & Measurement Laboratory, North University of China, Tai Yuan 030051, China. liuj@nuc.edu.cn.
Abstract
This paper focuses on an optimal quadrature error correction method for the dual-mass MEMS gyroscope, in order to reduce the long term bias drift. It is known that the coupling stiffness and demodulation error are important elements causing bias drift. The coupling stiffness in dual-mass structures is analyzed. The experiment proves that the left and right masses' quadrature errors are different, and the quadrature correction system should be arranged independently. The process leading to quadrature error is proposed, and the Charge Injecting Correction (CIC), Quadrature Force Correction (QFC) and Coupling Stiffness Correction (CSC) methods are introduced. The correction objects of these three methods are the quadrature error signal, force and the coupling stiffness, respectively. The three methods are investigated through control theory analysis, model simulation and circuit experiments, and the results support the theoretical analysis. The bias stability results based on CIC, QFC and CSC are 48 °/h, 9.9 °/h and 3.7 °/h, respectively, and this value is 38 °/h before quadrature error correction. The CSC method is proved to be the better method for quadrature correction, and it improves the Angle Random Walking (ARW) value, increasing it from 0.66 °/√h to 0.21 °/√h. The CSC system general test results show that it works well across the full temperature range, and the bias stabilities of the six groups' output data are 3.8 °/h, 3.6 °/h, 3.4 °/h, 3.1 °/h, 3.0 °/h and 4.2 °/h, respectively, which proves the system has excellent repeatability.
This paper focuses on an optimal quadrature error correction method for the dual-mass MEMS gyroscope, in order to reduce the long term bias drift. It is known that the coupling stiffness and demodulation error are important elements causing bias drift. The coupling stiffness in dual-mass structures is analyzed. The experiment proves that the left and right masses' quadrature errors are different, and the quadrature correction system should be arranged independently. The process leading to quadrature error is proposed, and the Charge Injecting Correction (CIC), Quadrature Force Correction (QFC) and Coupling Stiffness Correction (CSC) methods are introduced. The correction objects of these three methods are the quadrature error signal, force and the coupling stiffness, respectively. The three methods are investigated through control theory analysis, model simulation and circuit experiments, and the results support the theoretical analysis. The bias stability results based on CIC, QFC and CSC are 48 °/h, 9.9 °/h and 3.7 °/h, respectively, and this value is 38 °/h before quadrature error correction. The CSC method is proved to be the better method for quadrature correction, and it improves the Angle Random Walking (ARW) value, increasing it from 0.66 °/√h to 0.21 °/√h. The CSC system general test results show that it works well across the full temperature range, and the bias stabilities of the six groups' output data are 3.8 °/h, 3.6 °/h, 3.4 °/h, 3.1 °/h, 3.0 °/h and 4.2 °/h, respectively, which proves the system has excellent repeatability.
Entities:
Keywords:
dual-mass MEMS gyroscope; model simulation; quadrature error correction; system stability
The precision of MEMS gyroscopes has improved a lot in the last decade, reaching a tactical grade level [1,2,3,4]. Being of small size, low cost and light weight, MEMS gyros have been applied to more and more areas, such as in inertial navigation, roller detection, automotive safety, industrial control, railway siding detection, consumer electronics and stability control systems [4,5,6]. During use, the acceleration along the sense axis causes great errors in the MEMS gyroscope output signal, and the dual-mass gyroscope structure effectively prevents this phenomenon from occurring by employing differential detection technology. Therefore, numerous research institutes are interested in this structure [1,7,8,9]. Meanwhile, low drift and low output error are required in many application areas, especially in μPNT systems [10,11], so, the dual-mass gyro bias drift suppression method is investigated in this work.Most of the literature suggests that the dominant signal in output signals is the quadrature error, which is generated during the structure manufacturing process, and can produce an equivalent angular input of several hundred degrees per second [12,13,14,15,16]. The original source of quadrature is the coupling stiffness, which is modulated by drive mode movement and generates the quadrature error force. This force has the same frequency but a 90° phase difference with the Coriolis force, and stimulates the sense mode [14]. Most previous works utilize a phase-sensitivity demodulation method to extract the Coriolis signal from the sense channel [12,16], which requires accurate phase information and long term, full temperature range stability. However, demodulation phase errors and noise are usually present (sometimes more than 1° [12,15]) which creates undesirable bias. The coupling stiffness drift (the drive and sense modes’ equivalent stiffness vary with temperature and generate the coupling stiffness drift [7,14]) causes the quadrature error force drift, which is considered to be one of the most important reasons for bias long term drift, and has been proven [14,17] experimentally.Previous works provide several effective ways to reduce quadrature error, and basically three approaches to reduce errors after the structure is manufactured [12,14] have been found: quadrature signal compensation, quadrature force correction and coupling stiffness correction. In [12], the quadrature error is reduced by DC voltage based on a synchronous demodulation and electrostatic quadrature compensation method, and the sigma-delta technology is employed in ADC and DAC. The research in [17] also employs a coupling stiffness correction method to improve the performance of a “butterfly” MEMS gyroscope. The bias stability and scale factor temperature stability is enhanced, increasing from 89 °/h and 662 ppm/°C to 17 °/h and 231 ppm/°C, respectively, which achieves the correction goal. The quadrature error correction in dual-mass tuning fork MEMS gyro structures is investigated in [14], and this work also proves that the quadrature stiffness is different in the left and right masses. A quadrature error correction closed loop is proposed in the work, which utilizes the coupling stiffness correction method. The masses are corrected separately. The stiffness correction combs utilize the unequal gap method with DC voltages [18]. The bias stability improves from 2.06 °/h to 0.64 °/h with the Allan Deviation analysis method, and the noise characteristics are also optimized [14]. Another coupling stiffness correction approach is proposed in [8]. In this work, a coupling stiffness correction controller uses PI technology, and the quadrature error equivalent input angular rate is measured as 450 °/s, and the experiment in the work shows that the bias stability and ARW improve from 7.1 °/h and 0.36 °/√h to 0.91 °/h and 0.034 °/√h, respectively. In [19], quadrature signal is compensated based on charge injecting technology in the sense loop, and the compensation signal has the same frequency, amplitude and anti-phase as the quadrature error signal. The quadrature error correction method proposed in [9] employs both the quadrature force and stiffness correction methods. The modulation reference signal is generated by PLL technology, and the correction loop uses a PI regulator. Here, the two masses are controlled together. A novel quadrature compensation method is proposed in [20] based on sigma-delta-modulators (ΣΔM), whereby the quadrature error is detected by utilizing a pure digital pattern recognition algorithm and is compensated by using DC bias voltages. Accordingly, the system works beyond the full-scale limits of the analog ΣΔM hardware. The quadrature error is compensated by an open loop charge injecting circuit in [21], whereby the circuit is implemented on ASIC and the experimental results show that the quadrature error component is effectively rejected.The work in this paper focuses on an optimization method for the dual-mass MEMS gyroscope quadrature error correction, and an investigation into the best way to improve the long term drift performance. The coupled MEMS gyroscope structure is introduced, and the quadrature error correction methods are investigated using two main approaches: the realization methods, including correction of two masses and separate correction; and the correction methods, including charge injecting correction, quadrature force correction and quadrature stiffness correction. Each correction method is demonstrated by theory analysis, model simulation and experiments, and, finally, the best optimization method is confirmed. This paper continues as follows: Section 2 introduces the dual-mass structure and the model including quadrature error. Section 3 analyzes three different correction methods and their simulations. Section 4 outlines the experiments and tests the above correction methods. Then, in Section 5, the general experiments of optimization quadrature error correction method are conducted and the reliability and repeatability of the system are analyzed. The results are discussed and concluding remarks are given in Section 6.
2. Dual Mass MEMS Gyroscope Structure and Quadrature Error Model
2.1. Dual-Mass MEMS Gyroscope Structure
The dual-mass MEMS gyroscope researched in this paper is shown in Figure 1a. The structure is symmetrical, with a connecting spring. The drive mode is formed by a drive spring, drive frame, drive comb, connecting spring and drive sense comb. The sense mode is formed by a sense spring, sense frame, sense comb and sense feedback comb. The drive and sense springs support the entire active structure and decouple the drive and sense modes. The anchors are fixed with a glass bottom and support the springs. One side of the comb is connected with frames and moves with them, while the comb on the other side is fixed to a glass bottom and connected with metal lines to stimulate the capacitance or send the capacitance value signal to the interface. The left and right Coriolis masses generate the Coriolis force, and the quadrature error correction comb provides static electricity negative stiffness to compensate the quadrature coupling stiffness. The quadrature error correction combs are with unequal gaps and have been outlined in detail in the literature [14]. The drive anti-phase mode is shown in Figure 1b, and the sense anti-phase mode is shown in Figure 1c. The drive mode moves along the X axis while the sense mode vibrates along the Y axis. Since the left and right masses are coupled, the real working sense mode is the superposition of in-phase and anti-phase sense modes, but the anti-phase mode dominates the sense mode movement, and is the focus of the discussion in this work.
Figure 1
(a) Schematic and part photos of dual-mass gyroscope structure; (b) Drive anti-phase mode simulation; (c) Sense anti-phase mode simulation.
(a) Schematic and part photos of dual-mass gyroscope structure; (b) Drive anti-phase mode simulation; (c) Sense anti-phase mode simulation.
2.2. Quadrature Error Model
The movement equation with coupling stiffness and coupling damping of the gyroscope structure can be expressed as [14]:
where m and m are equivalent masses of drive and sense modes, respectively; c, c and k, k are effective damping and stiffness of drive and sense modes; c and c are coupling damping between drive and sense modes; k and k are coupling stiffness caused by machining error; x and y are the displacements of drive and sense frames; F is drive force; m is Coriolis mass and m ≈ m; Ω is the angular rate input around z axis. The stiffness elements in Equation (1) can be calculated by:
where k and k are the design stiffness along designed axes x and y; β and β are the quadrature error angle and they are the angles between practical axes and designed axes [14,22], and usually it is assumed that β = β. So, sense mode movement can be expressed with the following equation:The force can be divided into three parts: coupling stiffness force (quadrature error force) F, Coriolis force F and coupling damping force F. Since the drive mode movement can be described as x = Acos(ωt), the F and F are with same phase, and F has a 90 degree phase difference with them. Although F cannot be eliminated, high vacuum packaging is an effective method to decrease c and F. The mechanical parameters of the MEMS gyroscope are listed in Table 1. Substituting the parameter values into Equation (2), we can calculate that the quadrature error angle β is 0.15° approximately. Furthermore, the amplitude of F (2.68 × 10−7 N and the equivalent input angular rate Ω is 200 °/s) is over 60 times larger than F (2.68 × 10−9 N, the equivalent input angular rate Ω is 3.3 °/s), and F governs the sense mode force.
Table 1
MEMS gyroscope parameter values.
Parameter
Value
ωd
3488.9 × 2π rad/s
kx
593.9 N/m
ky
532.0 N/m
kyx, kxy
0.1719 N/m
cyx
1.29 × 10−7 N/m/s
Ax
1.56 μm
MEMS gyroscope parameter values.The sense loop employs phase sensitivity detection technology to pick up the Coriolis signal, and, in real working conditions, the demodulation reference signal is Vsin(ωt + φ + φ), and φ, φ are phase error and phase noise, respectively. The parameters Ω, Ω and Ω are the equivalent input angular rates of quadrature error, coupling damping error and the real input angular rate, respectively, and neglecting the other errors and noise, the gyro output angular rate value Ω can be expressed as [15]:We assume |Ω| < 200 °/s, |Ω| < 5 °/s, |φ + φ| < 2°, and let Ω = 0°/s. Figure 2a shows the curve of the relationship of Ω, Ω and φ + φ and Figure 2b shows the curve of the relationship of Ω, Ω and φ + φ. It is obvious that the Ω generates 7 °/s Ω signal when Ω = 200 °/s, Ω is almost proportional to Ω, and the demodulation phase error does not have much influence, so, briefly speaking, the Ω provides bias to Ω, and Ω is the dominated element of Ω when Ω is large enough. What is worse is that Ω changes with temperature and structure vibration stiffness, so the simple open loop compensation for Ω is not satisfactory. Therefore, the optimization quadrature error correction system for this gyro structure should be investigated.
Figure 2
(a) The relationship between Ω, φ + φ and Ω; (b) The relationship between Ω, φ + φ and Ω.
(a) The relationship between Ω, φ + φ and Ω; (b) The relationship between Ω, φ + φ and Ω.
2.3. Dual-Mass Quadrature Error Model
Figure 3 shows the equivalent stiffness and masses system and structure motion of the dual-mass gyro structure. The design drive and sense stiffness axis are x and y (gray); the real drive and sense axis of left and right masses after manufacturing are x, x (light blue color) and y, y (light yellow color), respectively; the stiffness of drive and sense modes of left and right masses after manufacture are k, k (dark blue color) and k, k (dark yellow color), respectively; the projections of k on −x and y axis are k and k; the projections of k on x and y axis are k and k; the projections of k on −x and y axis are k and k; the projections of k on x and y axis are k and k; the quadrature error angular of left and right masses are β and β.
Figure 3
(a) Stiffness system of ideal dual-mass gyro structure; (b) Ideal structure movement without angular rate input; (c) Ideal structure movement with constant angular rate input; (d) Stiffness system with in-phase quadrature error angular structure; (e) The movement of in-phase quadrature error angular structure without angular rate input; (f) The movement of in-phase quadrature error angular structure with constant angular rate input; (g) Stiffness system with anti-phase quadrature error angular structure; (h) The movement of anti-phase quadrature error angular structure without angular rate input; (i) The movement of anti-phase quadrature error angular structure with constant angular rate input.
In the design stage, |k| = |k|, |k| = |k|, and β = β = 0, but after the manufacturing process, the parameters change and they do not fit with the equations, so the coupling stiffness of the two masses is different. The drive-mode movement signal (channel 1), left and right masses sense signals (channels 2 and 3) and their superposed signal (channel 4) before quadrature error correction are tested and shown in Figure 4a. The left and right mass sense signals are of the same phase and frequency, and they are anti-phase with drive mode movement signals, which means that the main element in sense signals is quadrature error. The left and right mass sense signal amplitudes are 150 mV and 300 mV, respectively, which proves that the two masses’ quadrature errors are different.
Figure 4
(a) Test signals before quadrature error correction; (b) Test signals after quadrature error using the correction method with the two masses together.
(a) Stiffness system of ideal dual-mass gyro structure; (b) Ideal structure movement without angular rate input; (c) Ideal structure movement with constant angular rate input; (d) Stiffness system with in-phase quadrature error angular structure; (e) The movement of in-phase quadrature error angular structure without angular rate input; (f) The movement of in-phase quadrature error angular structure with constant angular rate input; (g) Stiffness system with anti-phase quadrature error angular structure; (h) The movement of anti-phase quadrature error angular structure without angular rate input; (i) The movement of anti-phase quadrature error angular structure with constant angular rate input.(a) Test signals before quadrature error correction; (b) Test signals after quadrature error using the correction method with the two masses together.
Two realization methods for dual-mass gyro quadrature error correction are discussed in this work: two masses corrected together and, two masses corrected separately. The “correction together” method entails providing the same correction signals to both masses and observing the two masses’ sense superposed signals. This method is tested with the CSC method, and the corresponding oscilloscope signals are shown in Figure 4b. It is obvious that the superposed signal does not have any quadrature error characteristics but noises. However, the left and right mass sensing signals are in-phase and anti-phase with the drive-mode movement signal, which indicates that two masses’ sense signals are still governed by quadrature error, and their amplitudes are nearly the same at about 35 mV. Although the “correction together” method removes more than 80% of the quadrature error, this method cannot eliminate quadrature error totally, and one mass (the left mass in Figure 4) is overcorrected. Therefore, each mass should be corrected separately to make sure its quadrature error is completely corrected.
3.1. Quadrature Error Correction Methods and Gyro System
From the above content, it can be concluded that the quadrature error is generated by the coupling stiffness k, which is modulated by drive mode movement and produces the quadrature error force F. The force stimulates the sense mode and quadrature error displacement occurs. This leads directly to a quadrature error signal in the sense loop, and after the occurrence of phase error in the demodulator, the quadrature error signal becomes one part of the gyro output. Consequently, this work divides this process into three stages as Figure 5 shows: the quadrature error stiffness stage, the quadrature error force stage and the quadrature error signal stage.
Figure 5
Diagram of quadrature error generating process and correction method.
Diagram of quadrature error generating process and correction method.Three different correction methods are proposed to deal with the three stages individually [14]:The charge injecting correction (CIC) method focuses on the quadrature error signal V in the sense loop, and does not influence the movement of the gyro structure.The quadrature force correction (QFC) method takes quadrature error force F as the controlling object, and does not change the stiffness of the structure.The coupling stiffness correction (CSC) method aims at the quadrature error coupling stiffness directly, and in theory, this method eliminates quadrature error fundamentally.The monitoring system of the gyro is shown in Figure 6. The drive loop employs a self-oscillation method using an AGC controller [23]. The drive-mode movement signals are picked up from left and right drive sense combs, and the displacement signals are transformed into electric signals with a differential instrument pre-amplifier. Its output signal has the same phase as the drive movement signal and is utilized for quadrature error demodulation. The phase of this signal is shifted 90 degrees and generates Vsin(ωt + φ + φ), which is used for Coriolis in-phase signal demodulation. The left and right sense frame displacements are picked up individually with a differential instrument pre-amplifier, and the output signals of sense pre-amplifiers are demodulated separately to achieve their own quadrature error values. The working principle and subquadrature error correction systems will be expanded in this section.
Figure 6
Diagram of the gyro monitoring system.
Diagram of the gyro monitoring system.
3.2. Charge Injecting Correction Method and System
The controlling object of CIC is the quadrature error electrical signal in the sense loop, and this method does not require structure cooperation, so it is fit for simple structures and sense open loops. In [16], this method is utilized to eliminate the quadrature signal and observe the Coriolis same-frequency signal, and good results were achieved. In Figure 5, the quadrature error signal V is demodulated by Vcos(ωt + φ + φ), V = 1.5 V, and the quadrature error amplitude (QEA) is picked up (because of φ + φ, QEA contains demodulation error). The two masses’ QEA are expressed as V and V. The CIC system diagram is shown in Figure 7. The left and right mass CIC systems share the same demodulation signal and comparator signal V. The right mass CIC system is analyzed as a sample to investigate the system stability. The cut-off frequency, quality factor and gain of F are 200 Hz, 1 and –10.
Figure 7
Dual-mass structure CIC system.
Dual-mass structure CIC system.The right mass sense pre-amplifier output signal V contains the Coriolis signal V, stiffness coupling signal V, damping coupling signal V, electrical cross-coupling signal V, force cross-coupling signal V and other elements [12], and can be expressed as:
where G is the force-voltage transform function of gyro structure; α and α are constant and are involved with coupling stiffness and damping; α and θ are the amplitude and phase difference of electrical cross-coupling signal; V is drive mode stimulating AC voltage amplitude; α and θ are the amplitude and phase difference of force cross-coupling signal. Then, ignoring the influence of θ and θ, and V can be written as:In Figure 7, we have:Combining Equations (6) and (7), and filtering the high frequency element, we can rewrite Equation (7) as:
where A is the quadrature error in-phase element in V signal. Combining Equations (8) and (9), it can be found that:There is one pole in Equation (11):Also, k, k, so p, the system is stable. When s = 0, the system is in a static state, then:Then, the quadrature error (cosine) component in q is:It is obvious from Equation (14) that the quadrature error component is basically eliminated. The system is simulated in Simulink soft, and the curves are shown in Figure 8: the first curve is the drive-mode motion x, the second and the third curves are the right-mass sense signal V and after quadrature error correction signal q. The gyro is started at 0 s, and the drive-mode is steady after 0.2 s, while the amplitude is about 1 μm. The CIC system is in a stable state after 0.5 s, the curves indicate that V has a 180 degree phase-difference with drive-mode movement, so the quadrature error signal is the main component of V. The peak-peak amplitude of q value is 0.8 mV and its phase is the same as Coriolis signal, which proves that the quadrature error signal is compensated completely.
Figure 8
(a) Right-mass CIC system simulation curves; (b) Enlarged curves of right-mass CIC system simulation result.
(a) Right-mass CIC system simulation curves; (b) Enlarged curves of right-mass CIC system simulation result.
3.3. Quadrature Force Correction Method and System
The QFC method requires the sense feedback comb to generate electrostatic force and balance the quadrature error force. Its controlling object is F in Figure 5. This method is usually utilized with a sense closed loop, and it restrains the sense mode quadrature error motion, so it is better than the CIC method in theory. However, QFC method needs the modulation step, which is also influenced by phase error elements. Similarly to the CIC method, the whole QFC system also has two sub systems: left and right masses systems. This paper takes the right mass QFC system as an example to illustrate QFC working principles and system stabilization. The right mass QFC system is shown in Figure 9. Since QFC changes force, this paper divides G into two parts, and this section discusses the right mass part G. Also, the low pass filter is the same one as in the CIC system. In order to make the analysis process clear, the quadrature error force is expressed by Ω. The voltage and force transform coefficient is K = 1.487 × 10-7 N/V. The electrostatic force is generated by DC (V = 5 V) and AC (V) power, and the force is proportional to their product. The DC power is constant and AC power is controlled to achieve accurate correction force. The refrernce voltage V = 0V, and k = 0.01, k = 1000.
Figure 9
Right mass QFC system.
Right mass QFC system.From Figure 9, the equations below can be obtained:Then, after Laplace Transform, Equations (15), (16) and (18) can be rewritten as:Substituting Equations (19) and (20) into Equation (21), considering the low-pass filter, and ignoring the double frequency elements, we can rewrite Equation (21) as:It is shown from the above equation that φ + φ introduces undesirable items, and we consider it is a small value (usually less than 2 degrees) and gradually-varying parameter, which generates bias and long-term drift but does not influence the QFC system’s stability. So, we assume φ + φ = 0°, and simplify Equation (22) as:Also, in Figure 9, we have:Combining Equations (23) and (24), we can find that:When the quadrature error equivalent angular rate is constant, s = 0, and the system is under stable conditions, then in Equation (25), we have:(a) QFC system Pole-Zero map; (b) QFC system Nyquist Diagram; (c) QFC system simulation curves; (d) QFC system start-up stage enlarged curves; (e) QEF system stable stage enlarged curves.Then, Equation (25) can be expressed as:Equation (27) shows that the controlling value is proportional to the quadrature error equivalent angular rate, and the coefficient can be adjusted by drive-mode amplitude, force generation DC power and demodulation signal amplitude. The QFC system is analyzed in the Simulink software, and the results are shown in Figure 10. In the Pole-Zero Map, all poles are distributed in the negative real axis, and, in the Nyquist Diagram, the curve does not contain a (−1, 0j) point, which indicates that the system is stable. The curves in Figure 10c show that in the start-up stage (t < 0.1 s), V is anti-phase with drive-mode movement, and this means the quadrature error signal is the dominating signal. After t = 0.7 s, the QFC system is in a stable stage, and V phase has a 90 degree difference with drive-mode movement, which shows that the quadrature error force is basically corrected.
Figure 10
(a) QFC system Pole-Zero map; (b) QFC system Nyquist Diagram; (c) QFC system simulation curves; (d) QFC system start-up stage enlarged curves; (e) QEF system stable stage enlarged curves.
3.4. Coupling Stiffness Correction Method and System
The CSC method utilizes quadrature error correction combs to generate negative electrostatic stiffness, and corrects quadrature error coupling stiffness. This special comb is an unequal gap style, and is introduced in [14,18]. Its stiffness is expressed as:
where, k and k are the quadrature error correction comb stiffness along designed axes x and y; k = −0.0049 N/m/V2 is the stiffness coefficient of correction comb; V = 5 V and V are the correction fixed voltage and controlling voltage; n = 45 is the number of combs; ε = 8.85 × 10−12 F/m is the permittivity of vacuum; h = 60 μm is the thickness of the comb; y = 4 μm and x are the parallel capacitance’s gap and overlap length, respectively; λ = 2.4 is a constant. Figure 11 shows the right mass CSC system which is the same as the left mass CSC system. In this figure, the coupling stiffness k is modulated by drive-mode movement, and the controller employs PI technology. The correction stiffness does not need to be modulated by quadrature error in-phase signal, which is better for circuit simplification and power consumption.
Figure 11
Right mass SCS system.
Right mass SCS system.Like the analysis process in the previous section, we can create the equations below:We have x = A and V, after the low-pass filter, V can be expressed as:Then, combining Equations (28), (30) and (31), we have:When the system is under stable state, s = 0, we design the PI controller parameters as k = 0.01, k = 2,500,000, and the above equation has:Then, it can be found that:The coupling stiffness is corrected. The CSC system is simulated and the curves are shown in Figure 12. The Pole-Zero Map is shown in Figure 12a, and no pole is in the positive real axis, which means the system is stable. Figure 12b is the Nyquist Diagram, and the curve does not contain a (−1, 0j) point, which also proves the system’s stability. The time domain simulation curves are shown in Figure 12c,d,f, and the curves indicate that the CSC system is in a stable state after about 0.7 s. It is obvious that in the start-up stage, the VRQS signal is mainly consisted of the quadrature error signal. However, in a stable state, the dominate element is the Coriolis in-phase signal. Furthermore, the overall coupling stiffness k is suppressed from its original value (about 0.18 N/m) to −0.00016 N/m, and k is basically corrected, which proves Equation (34).
Figure 12
(a) CSC system Pole-Zero map; (b) CSC system Nyquist Diagram; (c) CSC system simulation curves; (d) CSC system start-up stage enlarged curves; (e) CSF system stable stage enlarged curves.
(a) CSC system Pole-Zero map; (b) CSC system Nyquist Diagram; (c) CSC system simulation curves; (d) CSC system start-up stage enlarged curves; (e) CSF system stable stage enlarged curves.
4. Experimental Section and Discussion
The experimental equipment and gyro section view is shown in Figure 13. The structure is in a vacuum chip, and the circuits are configured on three PCB boards: PCB I contains the interface and drive closed loop and connects the structure chip; PCB II contains quadrature error demodulator, CIC and CSC systems; PCB III contains the QFC system and sense detection loop. The overall gyro is put in a steel shell, and the experiment is arranged on a turntable inside a temperature oven. The signals are observed with oscilloscope (DSO7104B, Agilent, Santa Clara, CA, USA), and the data is picked up by multimeter (Agilent 34401A) with a sample rate of one point per second. Three corrections are tested separately, and the curves are shown in Figure 14. The three signal curves are drive mode movement signal Vcos(ω), the left mass sense signal V and right mass sense signal V. Figure 14a is the CIC system testing result curves, and they show that V and V do not contain obvious quadrature error signals, which proves the theory analysis in Section 3.2. QFC system testing results are shown in Figure 14b, and the noise is the main characteristic of V and V, which means the quadrature error force is basically corrected. The CSC system testing results are shown in Figure 14c, and the curves indicate that the quadrature error is corrected. Furthermore, it can be concluded that the noise performance of CSC system is better than that of CIC and QFC, especially in V.
Figure 13
Experimental equipment and gyro section view.
Figure 14
(a) CIC system testing results; (b) QFC system testing results; (c) CSC system testing results.
Experimental equipment and gyro section view.The output signals of the three methods are also tested, and the results are shown in Figure 15. The output signal without quadrature error correction is shown in Figure 15a, where the curve drift trend is obvious and the bias stability is 38 °/h. Figure 15b shows the output signal after employing the CIC method. Since the quadrature error movement still exists, the drift trend is not optimized and the bias stability is 48 °/h. The QFC method focuses on the quadrature error force, and reduces bias drift trend distinctly (as shown in Figure 15c). Its bias stability improves a lot and achieves 9.9 °/h. The most effective quadrature error correction method is CSC, which can be proven by the drift trend curve. The bias stability of SCS is 3.7 °/h. So, this work considers that the CSC method is the optimal method for quadrature error correction. The general tests of the CSC system are outlined in the next section.
Figure 15
(a) Output signal without quadrature error; (b) Output signal with CIC system; (c) Output signal with QFC system; (d) Output signal with CSC system; (e) Allan deviation curves.
(a) CIC system testing results; (b) QFC system testing results; (c) CSC system testing results.(a) Output signal without quadrature error; (b) Output signal with CIC system; (c) Output signal with QFC system; (d) Output signal with CSC system; (e) Allan deviation curves.
5. CSC System General Tests
This section outlines the CSC system tests to inspect the full-temperature range stability and bias repeatability. The temperature test is arranged, the temperature is ranged from −40 °C to 60 °C, and the left and right masses’ CSC controller signals are observed (as shown in Figure 16). The gyro is warmed up to 60 °C, and the temperature is maintained for 20 min. Then, the gyro is cooled in 20 °C increments, until its temperature decreases to −40 °C, and after 20 min, it is warmed up to 60 °C again. During the process, V and V change with temperature, which means that the quadrature error coupling stiffness varies, and proves the inference in Section 2.
Figure 16
Full temperature range test results.
Full temperature range test results.Furthermore, the continuous curves indicate that the left and right CSC systems work well, and the values change by almost 50%. The gyro bias repeatability is tested also (each test continues 4800 s), and the six groups’ test results are shown in Figure 17.
Figure 17
(a)–(f) Six groups’ CSC system bias repeatability test curves; (g) Allan derivation of the six groups’ curves.
(a)–(f) Six groups’ CSC system bias repeatability test curves; (g) Allan derivation of the six groups’ curves.The results prove that the CSC method has excellent repeatability. The turntable tests (shown in Figure 18) are arranged with input angular rates Ω of ±0.1, ±0.2, ±0.5, ±1, ±2, ±5, ±10, ±20, ±50, ±100, ±200 °/s. Three repeat tests shows that the scale factor nonlinearity and repeatability are both improved with the CSC method. The results are summarized in Table 2.
Figure 18
Scale factor test, without quadrature error correction (a) and CSC method (b).
Table 2
Test summary.
System
Parameter
Value
CSC Test Group
Parameter
Value
Without correction
Bias value
4.16 °/s
Bias stability
38 °/h
ARW
0.66 °/√h
1
Bias value
1.747 °/s
Scale factor nonlinearity
925 ppm
Bias stability
3.8 °/h
Scale factor repeatability
818 ppm
2
Bias value
1.752 °/s
CIC method
Bias value
7.92 °/s
Bias stability
3.6 °/h
Bias stability
48 °/h
3
Bias value
1.748 °/s
ARW
2.07 °/√h
Bias stability
3.4 °/h
QFC method
Bias value
2.26 °/s
4
Bias value
1.741 °/s
Bias stability
9.9 °/h
Bias stability
3.1 °/h
ARW
0.77 °/√h
5
Bias value
1.744 °/s
CSC method
Bias value
1.749 °/s
Bias stability
3.0 °/h
Bias stability
3.7 °/h
6
Bias value
1.756 °/s
ARW
0.21 °/√h
Bias stability
4.2 °/h
Scale factor nonlinearity
660 ppm
Scale factor repeatability
403 ppm
Scale factor test, without quadrature error correction (a) and CSC method (b).Test summary.
6. Conclusions
This paper explores the most optimal quadrature error correction method for the dual-mass gyroscope. Based on quadrature error correction technology, the MEMS gyro’s long term drift can be efficiently suppressed, and the stability, and drift performance of the gyro are improved. Meanwhile, the structures with great coupling stiffness can achieve higher precision and demonstrate improved structure yields.In this work, the dual-mass structure is introduced, and the coupling stiffness system model is proposed, showing that the quadrature errors are different in the two masses. This theory is proved by experiments, suggesting that quadrature correction should utilize separate correction methods for the two masses. Then, the process that leads to quadrature error is analyzed, and is divided into three stages: coupling stiffness, quadrature error force and quadrature error signal. For these three stages, this work employs the charge injection correction (CIC) method, the quadrature error force correction (QFC) method and the coupling stiffness correction (CSC) method, respectively, to eliminate quadrature error within the different stages. The correction principles of each method are analyzed, and the system stabilities are assessed and simulated. Since CIC and QFC need to be modulated with quadrature error in-phase signals, the phase error and noise introduce more error to the system, and the CSC method avoids this process. Also, the CSC method targets the coupling stiffness source, so it should achieve better correction results.Finally, experiments are conducted. The curves show that every method can effectively mitigate the quadrature error, and the CSC method achieves better noise characteristics. The output signal before quadrature error correction demonstrates obvious drift, and the bias value, stability and ARW are 4.16 °/s, 38 °/h and 0.66 °/√h. The bias value, stability and ARW of CIC, QFC and CSC are 7.92 °/s, 48 °/h, 2.07 °/√h; 2,26 °/s, 9.9 °/h, 0.77 °/√h and 1.749 °/s, 3.7 °/h, 0.21 °/√h, respectively, which show CSC is the best method for this structure, and proves the theoretical analysis. The CSC system is also tested in the range of −40 ℃ to 60 ℃, and the results show that the left and right systems work well. The bias repeatability tests are done, and six groups’ curves prove the repeatability and reliability of the CSC system.
Authors: Antoni Broquetas; Adolf Comerón; Antoni Gelonch; Josep M Fuertes; J Antonio Castro; Damià Felip; Miguel A López; José A Pulido Journal: Sensors (Basel) Date: 2012-11-23 Impact factor: 3.576