The Analysis and Design of Closed-Loop Control System for MEMS Vibratory Gyroscopes

摘要

A digital closed-loop control system with all digital phase locked loop (ADPLL) is designed and optimized, in order to improve the bias stability and transient response of the gyroscope. The nonlinear mathematical models for the closed-loop amplitude and phase control system are established. The linearization method is applied to analyze the nonlinear models. The control parameters of the drive loop are optimized. The experimental results show that the phase deviation between the demodulation reference signal of the drive loop and the sense signal is less than 0.25° in the temperature range from -40°C to 60°C, within 0.15° of the variation. At room temperature, the overshoot amount of the gyroscope control system is 4.5% with setting time of 0.12s. The bias stability is 1.45°/h. Compared to the analog control scheme, the digital control system has advantages of short setting time, small overshoot, short phase locked time, large locked range, high phase precision, etc.