红外旋转弹导引头捷联惯导系统的姿态算法研究

对红外旋转弹导引头捷联惯导系统的算法进行了研究。分析了姿态更新的等效旋转矢量法及锥运动环境中的优化算法,理论推导了合理引入角位置传感器数据进行弹体姿态解算的方法,基于捷联惯导导引头坐标转换关系,通过欧拉角坐标转换和四元数坐标转换将导引头光轴系中的框架角速度转换至半弹体系中,由半弹体角速度解算出当前导引头的姿态和位置。试验结果验证证明了方法的正确性,解决了交班时扫描搜索阶段的弹体姿态求解问题,保证了对导弹姿态的有效控制。