一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法技术

本发明专利技术涉及一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法，实现两轴四框光电吊舱的一键快速自动陀螺漂移补偿。其特征是，在吊舱启动并自检后保持吊舱静止，此时保持采集吊舱外框和内框的角度，通过微分计算吊舱外框和内框相对与吊舱的角速度。根据框架的角速度解算出光轴移动的角速度，通过根据光轴移动的角速度，计算漂移补偿参数，使光轴在惯性空间内稳定，当光轴静态稳定性小于阈值时储存漂移补偿参数并自动退出自动漂移补偿状态。本发明专利技术的自动陀螺漂移补偿控制方法可同时补偿光电吊舱的方位和俯仰两个轴系，补偿速度快，补偿精度高，并可以实现一键漂移补偿。

【技术实现步骤摘要】

本专利技术属于自动控制技术，涉及一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法，用途是实现光电吊舱的一键自动高精度陀螺漂移补偿，代替目前吊舱上常用的手动漂移补偿。
技术介绍
由于光电吊舱内陀螺的物理特性，光电吊舱在上电后都会出现陀螺漂移的现象，陀螺漂移会使吊舱的图像随之漂移，破坏吊舱图像的稳定性，所以吊舱需要进行漂移补偿。现有的国内外吊舱大多采用手动陀螺漂移补偿的方法进行漂移补偿，手动补偿需要在吊舱陀螺漂移后观测吊舱视频的漂移方向，在吊舱手柄上设置专门的漂移补偿方向按键，手动操作按键，上下键补偿俯仰方向的漂移，左右键补偿方位方向的漂移，当吊舱的视频不再漂移时，手动储存补偿参数。手动漂移补偿耗费时间长，需要吊舱操作员耗费宝贵的时间进行操作，且补偿精度不好，补偿效果一般。此外手动需要在吊舱操作手柄上设置多个补偿按键，无法实现一键自动补偿，难以实现同时补偿方位和俯仰。
技术实现思路
要解决的技术问题为了避免现有技术的不足之处，本专利技术提出一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法。代替目前两轴四框吊舱一般采用的手动陀螺漂移补偿，实现吊舱的一键自动高精度陀螺补偿，简化光电吊舱的机上操作。技术方案一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法，其特征在于步骤如下：步骤1：在吊舱启动并自检后吊舱静止时，连续采集吊舱外框和内框的角度，计算吊舱外框相对与吊舱的角速度ωo和内框相对与吊舱的角速度ωi；步骤2：根据框架的角速度解算出光轴移动的角速度：ωaxis＝ωi+ωo+ωpod；其中：ωpod为吊舱相对与惯性空间在一个轴系上的的角速度，在吊舱静止时为零；步骤3：将光轴移动的角速度ωaxis输入吊舱的控制系统，控制系统输出漂移补偿参数；步骤4：将漂移补偿参数输入吊舱的稳定控制系统，改变控制系统输出的陀螺进动值；步骤5：当角速度ωaxis小于阈值时储存漂移补偿参数并自动退出自动漂移补偿状态。所述阈值为根据允许的每分钟最大视场漂移角度计算满足吊舱的稳定性阈值。所述阈值为0.001度/每秒。有益效果本专利技术提出的一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法，实现两轴四框光电吊舱的一键快速自动陀螺漂移补偿。其特征是，在吊舱启动并自检后保持吊舱静止，此时保持采集吊舱外框和内框的角度，通过微分计算吊舱外框和内框相对与吊舱的角速度。根据框架的角速度解算出光轴移动的角速度，通过根据光轴移动的角速度，计算漂移补偿参数，使光轴在惯性空间内稳定，当光轴静态稳定性小于阈值时储存漂移补偿参数并自动退出自动漂移补偿状态。本专利技术的自动陀螺漂移补偿控制方法可同时补偿光电吊舱的方位和俯仰两个轴系，补偿速度快，补偿精度高，并可以实现一键漂移补偿。附图说明图1是本专利技术光电吊舱自动陀螺漂移补偿框图图2是本专利技术光电吊舱自动陀螺漂移补偿算法流程图具体实施方式现结合实施例、附图对本专利技术作进一步描述：两轴四框光电吊舱方位和俯仰每个轴向上有外框和内框两个框架，在光电吊舱启动并自检后保持吊舱静止，此时让测角设备连续采集吊舱在方位和俯仰两个轴向上外框和内框的角度，通过微分计算出吊舱外框相对与吊舱在两个轴系上的角速度。设吊舱相对与惯性空间在一个轴系上的角速度为ωpod，吊舱外框相对于吊舱的角速度为ωo，吊舱内框相对于吊舱的角速度为ωi，吊舱光轴在对应的轴系上的角速度为ωaxis，则有ωaxis＝ωi+ωo+ωpod当吊舱静止时有ωpod＝0，因此根据内外框轴系移动的的角速度解算出光轴在两个轴系上的角速度。因此对于两轴四框吊舱，当吊舱静止时，吊舱外方位框相对于吊舱的角速度为ωX_o，吊舱内方位框相对于吊舱的角速度为ωX_i，吊舱外俯仰框相对于吊舱的角速度为ωY_o，吊舱内俯仰框相对于吊舱的角速度为ωY_i，吊舱光轴在方位轴系上的角速度为ωX，吊舱光轴在俯仰轴系上的角速度为ωY，则有：ωX＝ωX_i+ωX_oωY＝ωY_i+ωY_o将光轴在方位轴和俯仰轴移动的角速度ωX和ωY输入吊舱的控制系统，控制系统输出漂移补偿参数；将漂移补偿参数输入吊舱的稳定控制系统，改变控制系统输出的陀螺进动值，使光轴在惯性空间内稳定；吊舱方位轴的角速度ωX小于方位角速度阈值，且吊舱俯仰轴的角速度ωY小于俯仰角速度阈值时，储存漂移补偿参数并自动退出自动漂移补偿状态。阈值为根据方位和俯仰轴上允许的每分钟最大视场漂移角度计算出，实施例的俯仰阈值为0.0010°/s，方位阈值0.0013°/s。本文档来自技高网...

【技术保护点】
一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法，其特征在于步骤如下：步骤1：在吊舱启动并自检后吊舱静止时，连续采集吊舱外框和内框的角度，计算吊舱外框相对与吊舱的角速度ωo和内框相对与吊舱的角速度ωi；步骤2：根据框架的角速度解算出光轴移动的角速度：ωaxis＝ωi+ωo+ωpod；其中：ωpod为吊舱相对与惯性空间在一个轴系上的的角速度，在吊舱静止时为零；步骤3：将光轴移动的角速度ωaxis输入吊舱的控制系统，控制系统输出漂移补偿参数；步骤4：将漂移补偿参数输入吊舱的稳定控制系统，改变控制系统输出的陀螺进动值；步骤5：当角速度ωaxis小于阈值时储存漂移补偿参数并自动退出自动漂移补偿状态。

【技术特征摘要】
1.一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法，其特征在于步骤如下：步骤1：在吊舱启动并自检后吊舱静止时，连续采集吊舱外框和内框的角度，计算吊舱外框相对与吊舱的角速度ωo和内框相对与吊舱的角速度ωi；步骤2：根据框架的角速度解算出光轴移动的角速度：ωaxis＝ωi+ωo+ωpod；其中：ωpod为吊舱相对与惯性空间在一个轴系上的的角速度，在吊舱静止时为零；步骤3：将光轴移动的角速度ωaxis输入吊舱的控制系统，控制系统输...

【专利技术属性】
技术研发人员：张龙浩，徐梁，杜明昊，赵胜斌，沈腾，
申请(专利权)人：中国航空工业集团公司洛阳电光设备研究所，
类型：发明
国别省市：河南;41