CN106441366B - 一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法 - Google Patents
一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法 Download PDFInfo
- Publication number
- CN106441366B CN106441366B CN201610901400.9A CN201610901400A CN106441366B CN 106441366 B CN106441366 B CN 106441366B CN 201610901400 A CN201610901400 A CN 201610901400A CN 106441366 B CN106441366 B CN 106441366B
- Authority
- CN
- China
- Prior art keywords
- gondola
- drift compensation
- axis
- automatic
- photoelectric nacelle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法,实现两轴四框光电吊舱的一键快速自动陀螺漂移补偿。其特征是,在吊舱启动并自检后保持吊舱静止,此时保持采集吊舱外框和内框的角度,通过微分计算吊舱外框和内框相对与吊舱的角速度。根据框架的角速度解算出光轴移动的角速度,通过根据光轴移动的角速度,计算漂移补偿参数,使光轴在惯性空间内稳定,当光轴静态稳定性小于阈值时储存漂移补偿参数并自动退出自动漂移补偿状态。本发明的自动陀螺漂移补偿控制方法可同时补偿光电吊舱的方位和俯仰两个轴系,补偿速度快,补偿精度高,并可以实现一键漂移补偿。
Description
技术领域
本发明属于自动控制技术,涉及一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法,用途是实现光电吊舱的一键自动高精度陀螺漂移补偿,代替目前吊舱上常用的手动漂移补偿。
背景技术
由于光电吊舱内陀螺的物理特性,光电吊舱在上电后都会出现陀螺漂移的现象,陀螺漂移会使吊舱的图像随之漂移,破坏吊舱图像的稳定性,所以吊舱需要进行漂移补偿。
现有的国内外吊舱大多采用手动陀螺漂移补偿的方法进行漂移补偿,手动补偿需要在吊舱陀螺漂移后观测吊舱视频的漂移方向,在吊舱手柄上设置专门的漂移补偿方向按键,手动操作按键,上下键补偿俯仰方向的漂移,左右键补偿方位方向的漂移,当吊舱的视频不再漂移时,手动储存补偿参数。手动漂移补偿耗费时间长,需要吊舱操作员耗费宝贵的时间进行操作,且补偿精度不好,补偿效果一般。此外手动需要在吊舱操作手柄上设置多个补偿按键,无法实现一键自动补偿,难以实现同时补偿方位和俯仰。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法。代替目前两轴四框吊舱一般采用的手动陀螺漂移补偿,实现吊舱的一键自动高精度陀螺补偿,简化光电吊舱的机上操作。
技术方案
一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法,其特征在于步骤如下:
步骤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。
Claims (3)
1.一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法,其特征在于步骤如下:
步骤1:在吊舱启动并自检后吊舱静止时,连续采集吊舱在方位和俯仰两个轴向上外框和内框的角度,计算吊舱外框相对于吊舱的角速度ωo和内框相对于吊舱的角速度ωi;
步骤2:根据内外框轴系移动的角速度解算出光轴对应的轴系上的角速度:ωaxis=ωi+ωo+ωpod;其中:ωpod为吊舱相对于惯性空间在一个轴系上的的角速度,在吊舱静止时为零;
步骤3:将光轴移动的角速度ωaxis输入吊舱的控制系统,控制系统输出漂移补偿参数;
步骤4:将漂移补偿参数输入吊舱的稳定控制系统,改变控制系统输出的陀螺进动值;
步骤5:当角速度ωaxis小于阈值时储存漂移补偿参数并自动退出自动漂移补偿状态。
2.根据权利要求1所述两轴四框光电吊舱自动陀螺漂移补偿的实现方法,其特征在于:所述阈值为根据允许的每分钟最大视场漂移角度计算满足吊舱的稳定性阈值。
3.根据权利要求1所述两轴四框光电吊舱自动陀螺漂移补偿的实现方法,其特征在于:所述阈值为0.001度/每秒。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610901400.9A CN106441366B (zh) | 2016-10-18 | 2016-10-18 | 一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610901400.9A CN106441366B (zh) | 2016-10-18 | 2016-10-18 | 一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106441366A CN106441366A (zh) | 2017-02-22 |
CN106441366B true CN106441366B (zh) | 2019-06-21 |
Family
ID=58174716
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610901400.9A Active CN106441366B (zh) | 2016-10-18 | 2016-10-18 | 一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106441366B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107607128B (zh) * | 2017-08-31 | 2021-06-08 | 天津航天中为数据系统科技有限公司 | 一种两轴两框架稳定平台瞄准线精度补偿方法 |
CN108375997B (zh) * | 2018-02-15 | 2021-03-30 | 西安应用光学研究所 | 一种用于车载光电观瞄系统的两轴伺服控制系统正交性补偿方法 |
CN109506675A (zh) * | 2018-10-06 | 2019-03-22 | 中国航空工业集团公司洛阳电光设备研究所 | 一种用于光电吊舱的温度漂移自动补偿方法 |
CN110687782B (zh) * | 2019-09-10 | 2022-09-02 | 中国航空工业集团公司洛阳电光设备研究所 | 电力自动巡线吊舱角度从动稳态误差预测与前馈补偿控制方法 |
CN112747729B (zh) * | 2019-10-29 | 2024-03-26 | 中国科学院长春光学精密机械与物理研究所 | 一种基于图像视场匹配的光电吊舱陀螺漂移补偿的方法 |
CN111123831B (zh) * | 2019-12-05 | 2022-12-02 | 河北汉光重工有限责任公司 | 一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法 |
CN110954139B (zh) * | 2019-12-26 | 2023-06-13 | 洛阳伟信电子科技有限公司 | 一种用于微小型光电吊舱的陀螺漂移自动补偿方法 |
CN111238537B (zh) * | 2020-03-11 | 2023-06-02 | 西安应用光学研究所 | 机载光电观瞄系统瞄准线漂移智能补偿方法 |
CN112197803B (zh) * | 2020-09-29 | 2022-04-15 | 北京环境特性研究所 | 船载光电传感器控制方法和装置 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4686771A (en) * | 1986-08-28 | 1987-08-18 | Allied Corporation | Gyrocompassing apparatus for stationary equipment |
CN103149948B (zh) * | 2013-02-04 | 2015-04-22 | 北京航空航天大学 | 一种两自由度大负载跟踪稳定平台系统 |
CN104635746B (zh) * | 2013-11-14 | 2017-05-17 | 北京环境特性研究所 | 一种两轴四框架光电吊舱的伺服控制方法及系统 |
CN104811588B (zh) * | 2015-04-10 | 2018-04-20 | 浙江工业大学 | 一种基于陀螺仪的船载稳像控制方法 |
-
2016
- 2016-10-18 CN CN201610901400.9A patent/CN106441366B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106441366A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106441366B (zh) | 一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法 | |
US10527429B2 (en) | Sailing user interface systems and methods | |
EP3179211B1 (en) | Inertial measurement system for projectiles with corrections of roll angle and scale factor | |
CN104635746B (zh) | 一种两轴四框架光电吊舱的伺服控制方法及系统 | |
CN105785762B (zh) | 一种基于自适应反步滑模的两轴惯性稳定平台高精度控制方法 | |
Zhang et al. | Fuzzy-PID control for the position loop of aerial inertially stabilized platform | |
CN107992074A (zh) | 一种基于飞行路径角规划的再入轨迹设计方法 | |
CN109375651B (zh) | 一种运动平台地平式光电跟踪系统抗滚动轴扰动方法 | |
CN103285599A (zh) | 一种通过遥控手段直观领航靶机的方法 | |
CN104898429A (zh) | 一种基于自抗扰控制的三旋翼姿态控制方法 | |
CN107478110B (zh) | 一种基于状态观测器的旋转弹姿态角计算方法 | |
CN204137328U (zh) | 一种微型无人机快速拍摄比例尺正射影图的云台机构 | |
CN107807680A (zh) | 一种云台漂移补偿方法 | |
CN106090549A (zh) | 三轴稳定云台 | |
DE202011050944U1 (de) | Schwebende Kamerahalterung für Luftaufnahmen | |
CN109506638B (zh) | 一种补偿陀螺标度因数对旋转调制罗经方位对准影响方法 | |
CN106840194A (zh) | 一种大方位失准角线性对准方法 | |
CN105259750A (zh) | 一种四旋翼飞行器保持机体平衡的方法 | |
CN103488081A (zh) | 惯性稳定平台控制方法 | |
CN115562378B (zh) | 一种光电稳定平台、角速度补偿方法、存储介质 | |
CN107607128B (zh) | 一种两轴两框架稳定平台瞄准线精度补偿方法 | |
CN104252177A (zh) | 微小卫星对地凝视抗饱和跟踪控制方法 | |
DE102011080709A1 (de) | Schwebende Kamerahalterung für Luftaufnahmen | |
CN102662407B (zh) | 一种三轴望远镜的跟踪控制方法 | |
US20200089259A1 (en) | Course correction method and device, and aircraft |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20200609 Address after: 471000 No. 696, Wangcheng Avenue, Luolong District, Luoyang City, Henan Province Patentee after: AVIC Luoyang Photoelectric Technology Co., Ltd Address before: 471099 Luoyang City, Henan Province West triumph Road, No. 25 Patentee before: LUOYANG INSTITUTE OF ELECTRO-OPTICAL EQUIPMENT OF AVIC |