A MEMS gyroscope drive and detection mode preset performance anti-interference control method

Abstract

The invention discloses an anti-interference control method for MEMS gyroscope driving / detecting modal preset performance, and relates to the technical field of automatic control of MEMS gyroscopes. The conversion technology effectively solves the problem of a priori guarantee of gyroscope drive / detection modal dynamic / steady-state performance that cannot be achieved by the existing control methods in a strong interference environment; (2) Further combine the dynamic surface control idea to design a linear displacement loop virtual control (3) By constructing an extended state observer and reconstructing the linear velocity and lumped interference of the MEMS gyroscope, the MEMS gyroscope under the framework of output feedback control is realized. The robustness of the instrument measurement and control system is improved. The invention realizes the improvement of the dynamic / steady-state tracking performance of the offline displacement under the multi-source interference, and the improvement of the measurement accuracy of the angular velocity.

Description

technical field [0001] The invention relates to the technical field of automatic control of MEMS gyroscopes, in particular to a MEMS gyroscope drive / detection mode preset performance anti-interference control method, which is applied to strong external disturbances such as shock and vibration, coupling between gyroscope modes, and Guaranteed Robust Tracking Control of MEMS Gyroscope Mass under Parameter Uncertainty Environment. Background technique [0002] MEMS (Micro electromechanical system, abbreviated as MEMS) gyroscope, as an inertial sensor used to measure angular rate, has the advantages of small size, low cost, mass production, easy signal processing circuit integration, high precision and high reliability. It is not only the preferred angular rate sensor for the measurement of carrier angular rate information after the launch of military conventional weapons (such as artillery, tank guns) and new kinetic energy weapons (such as electromagnetic rail guns), but also ...

AI Technical Summary

Problems solved by technology

[0004] The present invention provides a MEMS gyroscope drive / detection mode preset performance anti-interference control method in order to solve the problem of robust tracking control of MEMS gyroscope mass block under strong interference environment, which is summarized as follows: (1) introduce preset Based on the performance control method, through the boundary function and error conversion technology, it effectively solves the problem of a priori guarantee of gyroscope drive / detection modal dynamic / steady-state performance that cannot be achieved by existing control methods in a strong interference environment; (2) further combining The virtual control quantity of the linear displacement loop is designed with the idea of ​​dynamic surface control, and the purpose of precise tracking of the given linear displacement command of the MEMS gyroscope is achieved; (3) The linear velocity and the lumped disturbance of the MEMS gyroscope are simultaneously reconstructed by constructing an extended state observer , to improve the robustness of the MEMS gyroscope measurement and control system under the framework of output feedback control

Images