Evaluation and optimization of strapdown velocity numerical integration algorithms for SINS in spinning ballistic missiles
来源期刊:中南大学学报(英文版)2013年第4期
论文作者:宋敏 WU Wen-qi(吴文启)
文章页码:942 - 949
Key words:strapdown inertial navigation system (SINS); spinning missile; error; velocity algorithm
Abstract: The error of the conventional velocity numerical integration algorithm was evaluated through the Taylor series expansion. It is revealed that neglecting the second- and higher-order terms of attitude increments will lead to the velocity numerical integration error, which is proportional to the triple cross product of the angular rate and specific force. A selection criterion for the velocity numerical integration algorithm was established for strapdown inertial navigation system (SINS) in spinning missiles. The spin angular rate with large amplitude will cause the accuracy of the conventional velocity numerical integration algorithm in SINS to decrease dramatically when the ballistic missile is spinning fast. Therefore, with the second- and higher-order terms of attitude increments considered, based on the rotation vector and the velocity translation vector, the velocity numerical integration algorithm was optimized for SINS in spinning ballistic missiles. The superiority of the optimized algorithm over the conventional one was analytically derived and validated by the simulation. The optimized algorithm turns out to be a better choice for SINS in spinning ballistic missiles and other high-precision navigation systems and high-maneuver applications.
SONG Min(宋敏), WU Wen-qi(吴文启)
(Department of Automatic Control, College of Mechatronics and Automation,
National University of Defense Technology, Changsha 410073, China)
Abstract:The error of the conventional velocity numerical integration algorithm was evaluated through the Taylor series expansion. It is revealed that neglecting the second- and higher-order terms of attitude increments will lead to the velocity numerical integration error, which is proportional to the triple cross product of the angular rate and specific force. A selection criterion for the velocity numerical integration algorithm was established for strapdown inertial navigation system (SINS) in spinning missiles. The spin angular rate with large amplitude will cause the accuracy of the conventional velocity numerical integration algorithm in SINS to decrease dramatically when the ballistic missile is spinning fast. Therefore, with the second- and higher-order terms of attitude increments considered, based on the rotation vector and the velocity translation vector, the velocity numerical integration algorithm was optimized for SINS in spinning ballistic missiles. The superiority of the optimized algorithm over the conventional one was analytically derived and validated by the simulation. The optimized algorithm turns out to be a better choice for SINS in spinning ballistic missiles and other high-precision navigation systems and high-maneuver applications.
Key words:strapdown inertial navigation system (SINS); spinning missile; error; velocity algorithm