[发明专利]一种用于微小型光电吊舱的陀螺漂移自动补偿方法

说明书

本发明涉及一种用于微小型光电吊舱的陀螺漂移自动补偿方法，包括失能吊舱方位、俯仰电机，使吊舱静止；采集N组方位陀螺角速度Ysubgt;1/subgt;、Ysubgt;2/subgt;……Ysubgt;N/subgt;、俯仰陀螺角速度Psubgt;1/subgt;、Psubgt;2/subgt;……Psubgt;N/subgt;；输入到卡尔曼滤波器中得数据后平均；将均值负数值输入吊舱控制系统的速度控制器中，计算出方位、俯仰两个轴系的漂移补偿参数ωsubgt;0/subgt;和ωsubgt;1/subgt;；（5）、将方位、俯仰陀螺漂移补偿参数ωsubgt;0/subgt;和ωsubgt;1/subgt;输入到稳定控制系统，抵消温度带给陀螺的漂移，存储补偿参数，改变控制系统进动值，使吊舱进入正常工作状态。本发明解决了陀螺数据因温度变化产生的图像漂移，使吊舱光轴在惯性空间稳定；补偿精度高，小视场下图像稳定性好；实用性强，可靠性好。

技术领域

本发明涉及一种自动控制领域技术，特别是一种用于微小型光电吊舱的陀螺漂移自动补偿方法。

背景技术

当前微小型光电吊舱通常采用价格较低的芯片级陀螺作为惯性测量器件，成本低的陀螺温漂和零漂较大，当系统长时间工作温度升高时，陀螺角速度会随着温度变化出现较大偏差，引起吊舱方位俯仰轴系方向上的角运动，影响光电吊舱的观测和操作。目前常用的陀螺补偿方法有两种，具体如下：

1对陀螺仪进行温度试验，定时采集记录温度与陀螺数据，建立温度变化的陀螺数据曲线关系图。后期通过查表的方式来补偿陀螺数据的漂移，该方法简单容易实现，但是采集的数据不是建立在吊舱工作环境下的，因此精度较低。

2 手动补偿方法，在人机交互界面上设置漂移补偿按键，当吊舱有温度漂移时，通过按下相应的按键增减陀螺角速度偏移量来进行补偿，该方法适用于温度变化较小的环境中，当温度变化较快时，补偿频率增加，影响吊舱其他功能操作，用户体验不理想。

本发明提出的陀螺自动补偿方法，可用在吊舱正常工作的任意时段（必须保证补偿期间吊舱处于静止状态），操作简单、无需借助辅助单元、可靠性高，极大的提高了系统的智能化水平。

发明内容

本发明所要解决的技术问题是提供一种用于微小型光电吊舱的陀螺漂移自动补偿方法，用于解决微小型光电吊舱陀螺数据漂移引起图像漂移，代替目前使用较多的手动陀螺补偿方法，实现一键自动高精度陀螺补偿，提高光电吊舱的智能化和实用性水平。

为了实现解决上述技术问题的目的，本发明采用了如下技术方案：

一种用于微小型光电吊舱的陀螺漂移自动补偿方法，包括使用卡尔曼滤波处理算法，微控制器采集光电吊舱多组方位、俯仰陀螺角速度数据，其特征是包括如下步骤：

（1）、通电自检：吊舱通电启动完成系统初始化及自检，失能吊舱方位、俯仰电机使得吊舱处于静止状态；

（2）、数据采集：确定吊舱处于静止状态后，微控制器连续采集N组方位陀螺角速度Y₁、Y₂… Y_N、俯仰陀螺角速度P₁、P₂… P_N；

（3）、数据处理：分别将N组方位、俯仰的陀螺角速度输入到卡尔曼滤波器中得到滤波后的数据，再对该数据进行平均计算得到方位陀螺角速度平均值Y、俯仰陀螺角速度平均值P，其中Y= （Y₁+Y₂… Y_N）/N， P=（P₁+P₂… P_N）/N；

（4）、计算补偿参数：将方位陀螺角速度平均值的负数值-Y、俯仰陀螺角速度平均值的负数值-P作为给定参数输入到吊舱控制系统的速度控制器中，此时设置速度控制器PWM输出占空比为50％，计算出方位、俯仰两个轴系的陀螺漂移补偿参数ω₀和ω₁；