Application of LQ optimal control in the initial alignment of Strapdown Navigation System

The paper presents a approach which applies LQ optimal control in Strap-down Inertial Navigation System(SINS) initial alignment. The detailed analysis process about this method has been given, and the anti-jamming design is done for the approximate step-wise disturbance appeared in the system, and this method has been used in the initial alignment. Simulations are performed to validate the scheme for initial alignment, obtained the same precision to other alignment method. And the most splendid is that the using of the LQ optimal control reduces the alignment time consumedly, much quicker than other traditional method. What is discovered in the simulation is when the initial error angles are smaller than 10 degrees, error angles will converge to quite good precision in several seconds.