An Automatic Phase Error Compensation Method for MEMS Quad Mass Gyroscope
Yi Zhou, Zhaorong Ke, Shaolei Ge, Shenhu Huang, Tong Zhou, Yan Su
Abstract
This paper demonstrates an automatic phase error compensation method for a Micro-Electro-Mechanical systems (MEMS) quad mass gyroscope (QMG) operating in Force-to-Rebalance (FRB) mode. First, the mechanical structure and dynamics of the QMG are introduced and analyzed. Then, the main source of phase error is identified, and the impact of phase error on both the gyroscope drive mode and sense mode is analyzed. To address this issue, an automatic phase error compensation method is developed based on identifying the phase value that corresponds to the minimum drive voltage amplitude. Additionally, a phase-compensated Phase-Locked Loop (PC-PLL) is designed to compensate for both the phase error and demodulation phase error. Simulation results validate the analysis of phase error. The experimental results demonstrate the effectiveness of the compensation method. After compensation, the scale factor is reduced from 331.895 LSB/°/s to 321.143 LSB/°/s and the calculated phase error is found to be 14.624°, which closely matches the compensated phase of 15°. Furthermore, the drift of quadrature suppression voltage decreases to less than 1% when the input angular rate range is within ±150 °/s after compensation. This extends the dynamic range of the QMG from ±45 °/s to ±150 °/s. The Allan variance curves shows that the angle random walk (ARW) remains relatively unchanged at 0.06 °/√h. However, the bias instability is improved to 0.147 °/h, representing a 1.25 times enhancement after phase compensation.