An Attitude Determining Method Based on Combination of Mems with Arbitrary Attitudes Without Initial Alignment

Abstract

The invention relates to a random attitude MEMS (Micro Electro Mechanical System) combined attitude determination method without initial alignment. The method comprises the following steps of: 1) defining and correcting Rodrigues parameters; 2) establishing a nonlinear attitude error state equation based on the corrected Rodriges parameters; 3) establishing a nonlinear observation equation of themagnetometer; 4) performing linearization processing on the nonlinear attitude error state equation and the observation equation of the magnetometer to obtain a state error linearization state error model and a magnetometer linearization observation model; 5) utilizing the obtained nonlinear state error equation and observation equation; and combining the linear state model and the observation model, obtaining the optimal estimation of the corrected Rodrigues parameters by utilizing an extended Kalman filtering method, and taking the optimal estimation as an attitude result for guidance control, thereby realizing the MEMS and magnetometer combination attitude determination of any attitude.

Description

technical field [0001] The invention belongs to the field of navigation and guidance, and relates to an arbitrary attitude MEMS combined attitude determination method without initial alignment. Background technique [0002] The navigation system is built with MEMS inertial devices as the main navigation equipment to achieve attitude determination and positioning through integral calculations, so initial alignment is required before launch. Generally, the commonly used initial alignment scheme needs to establish a reference point on the ground, and conduct optical aiming through the ground photoelectric theodolite to obtain the initial attitude information of the initial navigation system. It needs to be equipped with corresponding ground equipment and production operation procedures, which takes a long time for alignment and complicated combat preparations. The initial alignment time consumption is an important factor affecting the launch preparation time, and shortening th...

AI Technical Summary

Problems solved by technology

[0003] The technical problem solved by the present invention is: Aiming at the problem that the initial alignment takes time to reduce the combat effectiveness of weapons, a MEMS combined attitude determination technology for any attitude without initial alignment is proposed, and the three-axis attitude determination is realized through the magnetometer without the ground Equipped with launch preparation conditions, and greatly shorten the launch preparation time, effectively solving the initial alignment problem of MEMS inertial groups in unsupported launches

Images