一种滚仰式导引头及陀螺仪数据融合方法

技术领域

本申请属于航空飞行器技术领域，具体涉及一种滚仰式导引头及陀螺仪数据融合方法。

背景技术

导引头安装在制导武器头部，测量目标相对于制导武器的运动参数并产生制导信息的装置，作为巡飞弹的核心部件，为巡飞弹提供自主侦查、识别、跟踪服务，并提供制导所需要的视线角速度等信息，其性能直接决定了导弹的侦查效果、打击精度、毁伤效果等。

导引头根据其滚转方式不同分为偏仰式导引头和滚仰式导引头，与偏仰式导引头相比，滚仰式导引头具有较大的离轴角和视场角范围。

滚仰式导引头主要构成包括框架结构、伺服电机、陀螺仪、角度传感器、图像探测器、控制器。陀螺仪是其中重要的惯性器件，可作为姿态传感器检测载体的姿态变化，通过陀螺传感器获得的信息作为速度环的反馈可实现导引头平台的自稳定控制。

在实际飞行中，由于导引头平台框架自身转动的影响，导致视轴发生改变，在陀螺仪数据的使用过程中会考虑这些影响因素，会对其进行坐标转换，将这些物理量转换到同一坐标系内进行表示。

通常坐标系变换涉及矩阵运算，计算相对比较大，同时此方法在框架角0°附近时，滚仰式导引头因其结构特性，俯仰框与探测器视轴在同一方向，tan(0°)为0，1/tan(0°)为无穷大，出现奇异值现象，导致目标微小动作或俯仰框架角微小变动会导致导引头大幅度滚转。

针对上述问题，目前比较常用的解决方法是导引头俯仰框架角在0°附近时，在视线信息提取算法中将滚转框角速度信息保持上一时刻的值不变，但此方法会降低系统性能，同时，在低成本巡飞弹导引头中，为降低成本，会采用精度较低的位置传感器，导致测得的位置角精度较差，会导致解算出来的角速率存在较大误差。

因此，设计一种精度高、方法简单、易于工程实现新的滚仰式导引头，探索一种新的陀螺仪数据融合方法成为目前导引头技术领域亟待解决的技术问题。

发明内容

本申请的目的是提供一种滚仰式导引头，解决了目前现有传统导引头的陀螺仪模块集成度低，体积大，成本高的问题。

为解决上述问题，本申请所采用的技术方案是：

一种滚仰式导引头，包括基座、滚转框架、相机模组、伺服驱动机构，控制器，基座与滚转框架之间设置滚转轴，滚转框架通过滚转轴安装在基座上，相机模组与滚转框架之间设置俯仰转轴，相机模组通过俯仰转轴安装在滚转框架上，滚转框架上设置滚转陀螺仪模块，相机模组内设置俯仰陀螺仪模块。

所述俯仰滚转陀螺仪模块包括多片陀螺仪和电路板，所述多片陀螺仪以其中一片陀螺仪为基准，依次旋转90°后焊接在电路板上。

所述的滚转陀螺仪模块包括至少一片陀螺仪。

所述滚转轴上设置滚转轴位置传感器，所述俯仰转轴上设置俯仰转轴位置传感器，滚转轴位置传感器和俯仰转轴位置传感器采用AD采集芯片，用于读取位置信息，实现滚转和俯仰角度测量。

另外，本申请还提供了一种滚仰式导引头的陀螺仪数据融合方法，其方法如下：定义导引头的框架坐标系O

在控制器中设置读取周期，定时完成俯仰陀螺仪模块上多片陀螺仪三轴数据的读取，滚转陀螺仪模块的X

根据导引头视线坐标系的定义，重新定义X

对X

为实现导引头视轴的稳定控制，需要对框架进行闭环控制，需要知道滚转和俯仰框架的角速率，因为陀螺仪布置在俯仰轴上，测得的角速率是在视线坐标系下测得，不能反映滚转和俯仰框架的真实角速率，为此需要将导引头的视线坐标系转换到导引头的框架坐标系，需要先绕X

根据导引头的视线坐标系与框架坐标系的俯仰轴为同一个结构框架，导引头的视线坐标系与框架坐标系的Z轴重合，得到框架坐标系的Z

定义θ为坐标系X

(ω

稳定控制所需的俯仰角速度：ω

根据得到的X

申请的有益效果是：

1.本申请一种滚仰式导引头的俯仰陀螺仪模块由多片低成本陀螺仪组成，滚转陀螺仪模块采用一片低成本陀螺仪，代替了目前使用的高成本的陀螺仪，螺仪模块在结构布局上进行优化设计，在导引头的俯仰陀螺仪模块上采用了多片低成本陀螺仪组合的结构设计，能够达到甚至优于目前所目前所使用的高成本陀螺仪所能达到的技术效果，具有集成度高、尺寸小、成本低特点。

2.本申请针对滚仰式导引头的螺仪模块结构上改进，特别设计滚仰式导引头的陀螺仪数据融合方法，在对三轴数据处理上引入容错设计，剔除异常数据后对剩余数据进行融合处理，相比于传统的单个陀螺仪，可有效剔除异常值，容错能力也大幅提高，同时数据精度也大幅提升。

3.本申请滚仰式导引头的陀螺仪数据融合方法中，对滚转及俯仰方向角速率提取时，由于导引头的视线坐标系与框架坐标系的俯仰轴为同一个结构框架，导引头的视线坐标系与框架坐标系的Z轴重合，得到框架坐标系的Z

附图说明

图1是本申请一种滚仰式导引头的结构示意图；

图2是本发明的导引头的视线坐标系与导引头的框架坐标系关系图；

图3是本发明的简化之后导引头的视线坐标系与导引头的框架坐标系关系图；

图4是本申请的俯仰陀螺仪模块布局示意图；

图5是本申请的陀螺仪坐标系布局示意图；

图6是本申请采用的融合方法得到滚转角速率与直接测量值的对比图；

图7是图6的局部放大图。

附图标记说明：

图中：1、基座；2、滚转框架；3、相机模组；4、伺服驱动机构；5、滚转轴；6、俯仰转轴；7、滚转陀螺仪模块；8、俯仰陀螺仪模块；9、滚转轴位置传感器；10、俯仰转轴位置传感器。

具体实施方式

为能清楚说明本方案的技术特点，下面通过具体实施方式，并结合其附图，对本方案进行阐述。

在本申请的描述中，需要说明的是，除非另有明确的规定和限定，术语“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以具体情况理解上述术语在本申请中的具体含义。

如图1所示，本申请公开了一种滚仰式导引头，包括基座1、滚转框架2、相机模组3、伺服驱动机构4、控制器，伺服驱动机构4作为动力和驱动机构分别用于驱动滚转框架2的轴向滚转以及相机模组3的俯仰滚转运动。

在基座1与滚转框架2之间设置滚转轴5，滚转框架2通过滚转轴5安装在基座1上，在伺服驱动机构的驱动下，滚转框架2可绕滚转轴5在基座1上发生轴向转动。相机模组3通过俯仰转轴6安装在滚转框架2上，相机模组3在伺服驱动机构4驱动下可沿俯仰转轴6进行俯仰转动。

在滚转框架2上设置滚转陀螺仪模块7，滚转陀螺仪模块7由一片陀螺仪组成，该片陀螺仪焊接在电路板上，并安装在滚装框架2上。

在相机模组3内设置俯仰陀螺仪模块8，俯仰滚转陀螺仪模块8包括四片陀螺仪和用于安装四片陀螺仪的电路板，四片陀螺仪以其中一片陀螺仪为基准，依次旋转90°后分别对应焊接在电路板上。

在滚转轴6上设置滚转轴位置传感器9，俯仰转轴7上设置俯仰转轴位置传感器10，滚转轴位置传感器9和俯仰转轴位置传感器10均采用AD采集芯片，用于读取位置信息，实现滚转和俯仰角度测量。

本申请还公开公开了一种滚仰式导引头的陀螺仪数据融合方法，其具体方法如下：定义坐标系，分别定义导引头的框架坐标系O

如图2所示，导引头框架坐标系O

导引头视线坐标系O

如图4、图5所示，陀螺仪芯片坐标系OXYZ：芯片1引脚标示符位于左上方，OX轴为平行于芯片平面，且向右为正，OY轴为平行于芯片平面，且向上为正，OZ轴为垂直于芯片平面，且向上为正。

俯仰陀螺仪模块放置于成像模组上，与导引头视线坐标系重合，即坐标系O

在控制器中设置读取周期，定时完成俯仰陀螺仪模块上4片陀螺仪三轴数据读取，滚转陀螺仪模块的X

因陀螺仪芯片布置方向各不相同，且与视线坐标系不一致，为此根据视线坐标系的定义，重新定义X

对X

处理得到的三轴数据为视线坐标系三轴角速率值，进行导引头伺服框架速度闭环，为实现导引头视轴的稳定控制，需要对框架进行闭环控制，需要知道滚转和俯仰框架的角速率，因为陀螺仪布置在俯仰轴上，测得的角速率是在视线坐标系下测得，不能反映滚转和俯仰框架的真实角速率，为此需要将其视轴坐标系转换到导引头框架坐标系，即需要知道X

结合图3可知，视轴坐标系转换到框架坐标系，需要先绕X

简化后坐标系为两轴坐标系，θ为坐标系X

即有伺服稳定控制所需的滚转角速度ω

(ω

伺服稳定控制所需的俯仰角速度：ω

避免了传统提取方法需要使用θ角度的弊端，同时也避免产生奇异值的问题。

解算得到|ω

根据得到的X

其中，Z

结合图6、图7所示，本申请所采用的陀螺仪数据融合方法相对于传统的方法得到的框架角速率精度得到大幅提升，有效避免了奇异值问题，且性能稳定、容错性好、成本低。

采用传统坐标变换需进行矩阵计算，且用到俯仰框架角度，在低成本巡飞弹导引头中，位置传感器精度较低，会增大速率提取误差，降低控制精度。具体传统方法为：

坐标系变换：导引头框架坐标系O

θ

导引头框架坐标系O

其中，ω

θ

ω

在理想情况下，实现导引头视轴稳定，需要X、Z轴感受到的扰动速率为零即：

即：

即有：

ω

但在θ

以上所述只是本申请的优选实施方式，对于本技术领域的普通技术人员来说，在不脱离本申请原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也被视为本申请的保护范围。