Roll Angle Estimation Method of High-rotation Flying Body Based on Phase-locked Loop
In order to accurately measure the roll angle of the high-spinning flying body,a roll angle motion model was established by analyzing the motion characteristics,and a roll angle estimation method based on geomagnetic information and phase-locked tracking was proposed.First,the angular frequency information measured by geomagnetic sensor was extracted by least square zero-crossing detection method,and the rotational speed information of high spinning flying body was solved.Then,the filter parameters of the third-order phase-locked loop were determined according to the angular motion characteristics of high spinning flying body and the measured signals of pitch and yaw axis gyroscopes,and the extracted angular frequency information and rotational speed information were tracked by frequency-locked phase-locked tracking.The roll angle estimation method was verified by the simulation and test.The results show that the third-order phase-locked loop method is utilized to effectively track the roll angular frequency of the high-spinning flying body,and the roll angular velocity and roll angle can be obtained to meet the requirements of real-time attitude solution of the high-spinning flying body.
high spinning flying bodythird-order phase-locked looproll angle frequencyroll attitudetest validation
NETL
NSTL
万方数据
