基于导引头多传感器的旋转导弹弹体姿态信息提取方法

摘要

本发明涉及一种基于导引头多传感器的旋转导弹弹体姿态信息提取方法，包含：S1、根据内框码盘、外框码盘和消旋陀螺的输出信息，构造光轴坐标系到准弹体坐标系的转换矩阵；S2、根据内框陀螺、外框陀螺和稳定陀螺的输出信息，以及S1中的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息；S3、根据内框码盘、外框码盘和消旋陀螺的输出信息，以及S1中的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息；S4、根据S2和S3，计算准弹体坐标系相对于惯性坐标系的角速度信息。本发明在不增加传感器的情况下，利用导引头和消旋平台上的传感器信息，通过信息复用算法得到弹体姿态信息，实现制导控制，有效提升弹体阻尼及导弹动态性能。