A Compensation Method for Mems Gyro Drift Error Based on Mems Coupling

Abstract

The invention discloses a compensation method for MEMS (Micro-electromechanical Systems) gyroscopic drifting errors based on accelerometer coupling. The compensation method comprises the following steps: (1) a gyroscopic drifting error amount delta omega (t) is obtained according to carrier accelerated speed information which is measured in real time according to an accelerometer; (2) an error adjusting model omega C (t)=delta omega P+delta omega I is established; a first error adjusting control amount delta omega P and a second error adjusting control amount delta omega I are obtained according to formulas delta omega P=KP*delta omega (t) and delta omega I =delta omega I+KI*dt*delta omega (t), and the gyroscopic drifting error amount delta omega (t); the first error adjusting control amount delta omega P and the second error adjusting control amount delta omega I are substituted into the error adjusting model to obtain a gyroscopic drifting error compensation amount omega C (t); (3) error compensation is carried out on gyroscopic data according to the gyroscopic drifting error compensation amount to obtain compensated gyroscopic information. According to the compensation method disclosed by the invention, the problems that the posture resolving precision is low and engineering applications cannot be met caused by low gyroscopic precision of MEMS and large accumulated drifting errors are solved; the MEMS gyroscopic drifting can be inhibited and the posture resolving precision is improved; the compensation method has high engineering application values and promotional values.

Description

technical field [0001] The invention belongs to the technical field of inertial navigation, and more specifically relates to a method for compensating MEMS gyro drift errors based on meter-added coupling. Background technique [0002] In the inertial navigation system, the information processing of gyroscope and accelerometer (plus meter) is directly related to the calculation accuracy of the carrier attitude, and the attitude is an important parameter reflecting the movement of the carrier. Tracking, motion trajectories, performance analysis, etc. have an important impact. Usually the attitude solution is to calculate the carrier attitude matrix in real time according to the data of the gyroscope and the speed and position information of the carrier, so as to realize the real-time follow-up of the navigation coordinate system to the geographic coordinate system and the solution of the carrier attitude. However, due to the limited accuracy of gyroscopes and accelerometers, ...

AI Technical Summary

Problems solved by technology

[0003] Aiming at the defects of the prior art, the purpose of the present invention is to provide a method for compensating the MEMS gyro drift error based on the coupling of the meter, aiming at solving the problem that the accuracy of the attitude calculation is relatively low due to the low precision of the MEMS gyro and the large drift error in the prior art. low technical issues

Images