[发明专利]基于导引头多传感器的旋转导弹弹体姿态信息提取方法

说明书

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

技术领域

本发明涉及一种旋转导弹弹体姿态信息的提取方法，具体是指一种基于导引头多传感器的旋转导弹弹体姿态信息的提取方法，能够在不增加额外传感器的情况下，利用导引头及消旋平台的传感器信息资源提取旋转导弹弹体姿态信息，用于制导控制，提升导弹的动态性能；属于旋转导弹导航、制导与控制的技术领域。

背景技术

对于旋转导弹而言，由于受到导弹弹体旋转速度的限制，其弹体姿态和运动信息的测量一般需安装消旋平台和相应的陀螺。

目前，用于防空的旋转导弹多采用低成本设计，并且不对弹体姿态进行测量，制导控制系统采用开环控制，这种方式的局限性有以下两方面：

1、导致导弹阻尼偏小，一般不大于0.3，而过载响应的超调较大，半震荡次数大于3，且稳定时间长。

2、旋转导弹的制导控制系统抗气动摄动能力差，鲁棒性差，制导精度容易受到影响。

发明内容

本发明的目的是提供一种基于导引头多传感器的旋转导弹弹体姿态信息提取方法，在不增加传感器的情况下，利用导引头和消旋平台上的传感器信息，通过信息复用算法得到弹体姿态信息，从而实现制导控制，有效提升弹体阻尼及导弹的动态性能。

为实现上述目的，本发明提供一种基于导引头多传感器的旋转导弹弹体姿态信息提取方法，包含以下步骤：

S1、根据内框码盘、外框码盘和消旋陀螺的输出信息，构造光轴坐标系到准弹体坐标系的转换矩阵；

S2、根据内框陀螺、外框陀螺和稳定陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息；

S3、根据内框码盘、外框码盘和消旋陀螺的输出信息，以及光轴坐标系到准弹体坐标系的转换矩阵，计算准弹体坐标系相对光轴坐标系的角速度信息；

S4、根据S2和S3，计算准弹体坐标系相对于惯性坐标系的角速度信息。

所述的引导头采用红外凝视成像导引头。

所述的S1中，光轴坐标系通过三次旋转可与准弹体坐标系完全重合，三次旋转的角度由导引头上的内框码盘、外框码盘和消旋平台上的消旋陀螺的输出信息获得，通过这三个旋转的角度来构造光轴坐标系到准弹体坐标系的转换矩阵：

其中，L(-γ,-λ_y,-λ_z)为光轴坐标系到准弹体坐标系的转换矩阵；γ为消旋平台与导弹弹体纵轴之间的角度，通过消旋陀螺积分输出；λ_y为外框架转角，通过外框码盘直接输出；λ_z为内框架转角，通过内框码盘直接输出。

所述的S2中，导引头上的内框陀螺、外框陀螺和稳定陀螺分别测量得到光轴坐标系相对惯性坐标系的角速度信息在光轴坐标系下的表示，并且结合S1中得到的光轴坐标系到准弹体坐标系的转换矩阵，计算光轴坐标系相对惯性坐标系的角速度信息在准弹体坐标系下的表示：