CN103630138A - 基于摄像机头标定算法的无人机视觉导航方法 - Google Patents
基于摄像机头标定算法的无人机视觉导航方法 Download PDFInfo
- Publication number
- CN103630138A CN103630138A CN201310681795.2A CN201310681795A CN103630138A CN 103630138 A CN103630138 A CN 103630138A CN 201310681795 A CN201310681795 A CN 201310681795A CN 103630138 A CN103630138 A CN 103630138A
- Authority
- CN
- China
- Prior art keywords
- camera head
- calibration algorithm
- head calibration
- unmanned plane
- unmanned aerial
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明属于视觉导航领域,具体涉及一种基于摄像机头标定算法的无人机视觉导航方法,利用摄像机头标定算法,利用模板的角点检测结果,实现载体的位置解算,并采用UKF滤波实现与惯性导航***参数的数据融合,从而实现视觉导航信息对惯性导航***误差的修正,获得精确的导航坐标。适合中小型无人机的高定位精度、微型化及低成本的特点,具有理论与实用价值。
Description
技术领域
本发明属于视觉导航领域,涉及一种基于摄像机头标定算法的无人机视觉导航方法,特别针对小型无人机的高定位精度、微型化及低成本的要求。
背景技术
近年来,无人机(UAV)在军事上的作用日趋重要,如美国研制的“捕食者”、“全球鹰”、A160,法国的“鹰”,西欧国家(EADS公司)的HALE无人机。美国的无人机动力装置为1台双路涡喷发动机,控制***采用惯性+“导航星”空间无线电导航***数据修正方式。机载模块化侦察设备包括侧视雷达、光电侦察***、无线电技术侦察和无线电电子对抗设备、一体化数据接收与传递***、ATACCS目标指示***、转发设备等。海军型还将装备有水面活动目标选择***的扫描雷达。美国军事专家通过分析“全球鹰”无人机的作用使用经验,发现该机还有一系列缺点,主要是有效载荷的重量和体积有限,能源***功率不足,每次出动不能保证所有侦察设备同时运行。因此,相对于大型军用机,无人机要求具有低成本、小尺寸、低功耗、高精度的特点,以便于其运输、发射和回收。
先进的导航***是决定无人机完成作战任务、提高生存力的关键。近十年来,无论在定位、跟踪还是在自主信息处理及无人机载荷方面的发展已取得重大进展,如现代卫星导航技术、惯性导航***、通讯和监控技术等,此外,新的视觉感知和处理设备也已经装备到无人机上。为了在未知的、动态变化的复杂环境中执行任务,在大多数情况下,无人机使用全球定位***(GPS)导航定位和惯性导航***(IMU)。GPS的估计精度直接取决于参与定位的卫星的数量以及接收设备接收信号的质量与电台的影响。此外,相邻设备的无线电频率干扰或信道堵塞都可能导致位置估计的不可靠,而这些问题又是普遍存在且难以解决。在无法使用或获得有效GPS信号的时候,无人机的导航***只能依靠惯性导航***,而高精度的惯性导航***依靠于高精度的传感器,这一方面增加了成本,一方面增加了无人机的载荷。另外,由于惯导***的位置误差随时间的增长而积累,所以必须由外部信息校正,如果携带如无线电、激光扫描仪等设置,对于中小型无人机(MUAV),载荷重量是一个最大限制。而视觉传感器重量轻、功耗小、探测距离远、分辨率高,是中小型无人机视觉导航的优选载荷。
因此,本发明旨在研究如何利用视觉信息辅助惯性导航***,提出基于摄像机头标定的无人机视觉导航方法研究,正是为了适合中小型无人机的高定位精度、微型化及低成本的特点,具有理论与实用价值。
发明内容
本发明重点研究无人机视觉导航***的定位技术。解决利用摄像机标定算法相机坐标,从而解算出载***置,解决视觉信息与惯性导航***参数的数据融合问题,实现视觉信息对惯性导航***误差的修正,获得精确的导航坐标。具体的研究方案如图1所示。主要内容如下:
1)基于摄像机头标定算法实现载***置解算;
2)设计UKF滤波器对无人机的运动状态和视觉特征的位置进行估计,从而获得无人机的导航参数。
附图说明
图1是本发明的研究方案图。
图2是本发明的UKF滤波融合视觉信息与惯性导航参数的原理。
具体实施方式
主要环节的具体设计思路如下:
(1)基于摄像机头标定算法实现载***置解算
通过3步完成:
a)建立***各坐标系:建立世界坐标系(xw,yw,zw)、载体坐标系(xo,yo,zo)、相机坐标系(xc,yc,zc),相平面坐标(x,y),图像坐标(u,v)。
b)摄像机标定模板的角点检测:利用harris角点检测算法,检测模板上角点的位置坐标。
c)像机内外参数矩阵M1,M2的解算:由角点二维坐标和三维坐标根据公式1解算像机的内处参数矩阵,从而解算出载体在世界坐标系下的坐标。
(2)基于UKF滤波的数据融合
利用UKF滤波器融合视觉信息修正惯性导航***测量误差。定义无人机方向角为(φ,θ,ψ),陀螺偏差为(bp,bq,br),视觉信息为(φv,θv,ψv),***状态变量选择x=[φ θ ψ bp bp br]T,观测变量选择[φv θv Ψv],建立***的状态方程及观测方程,利用UKF滤波递推方程估计载体的位置姿态信息,基于UKF滤波融合视觉信息与惯性导航参数的原理如图2所示。
本发明的优点在于,导航摄像机与MEMS惯性导航器件所组成的导航***成本低廉,体积小,操作方便,精度高,满足小型无人机的载荷、尺寸、功率、成本等方面的需要,具有良好的应用前景。
Claims (3)
1.基于摄像机头标定算法的无人机视觉导航方法利用摄像机头标定算法相机位置的解算,从而给出载***置信息,并采用UKF滤波实现与惯性导航***参数的数据融合,从而实现视觉导航信息对惯性导航***误差的修正,获得精确的导航坐标。
2.根据权利要求1所述的基于摄像机头标定算法的无人机视觉导航方法,其特征在于,采用摄像机头标定算法实现载体的位置解算。
3.根据权利要求1所述的基于摄像机头标定算法的无人机视觉导航方法,其特征在于,设计UKF滤波器对无人机的运动状态和视觉特征的位置进行估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310681795.2A CN103630138A (zh) | 2013-12-09 | 2013-12-09 | 基于摄像机头标定算法的无人机视觉导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310681795.2A CN103630138A (zh) | 2013-12-09 | 2013-12-09 | 基于摄像机头标定算法的无人机视觉导航方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103630138A true CN103630138A (zh) | 2014-03-12 |
Family
ID=50211426
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310681795.2A Pending CN103630138A (zh) | 2013-12-09 | 2013-12-09 | 基于摄像机头标定算法的无人机视觉导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103630138A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9778661B2 (en) | 2014-12-31 | 2017-10-03 | SZ DJI Technology Co., Ltd. | Selective processing of sensor data |
CN108225371A (zh) * | 2016-12-14 | 2018-06-29 | 北京自动化控制设备研究所 | 一种惯导/相机安装误差标定方法 |
CN108340371A (zh) * | 2018-01-29 | 2018-07-31 | 珠海市俊凯机械科技有限公司 | 目标跟随点的定位方法以及*** |
CN109974713A (zh) * | 2019-04-26 | 2019-07-05 | 安阳全丰航空植保科技股份有限公司 | 一种基于地表特征群的导航方法及*** |
CN110398258A (zh) * | 2019-08-13 | 2019-11-01 | 广州广电计量检测股份有限公司 | 一种惯性导航***的性能测试装置及方法 |
US10565732B2 (en) | 2015-05-23 | 2020-02-18 | SZ DJI Technology Co., Ltd. | Sensor fusion using inertial and image sensors |
-
2013
- 2013-12-09 CN CN201310681795.2A patent/CN103630138A/zh active Pending
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9778661B2 (en) | 2014-12-31 | 2017-10-03 | SZ DJI Technology Co., Ltd. | Selective processing of sensor data |
US10802509B2 (en) | 2014-12-31 | 2020-10-13 | SZ DJI Technology Co., Ltd. | Selective processing of sensor data |
US10565732B2 (en) | 2015-05-23 | 2020-02-18 | SZ DJI Technology Co., Ltd. | Sensor fusion using inertial and image sensors |
CN108225371A (zh) * | 2016-12-14 | 2018-06-29 | 北京自动化控制设备研究所 | 一种惯导/相机安装误差标定方法 |
CN108225371B (zh) * | 2016-12-14 | 2021-07-13 | 北京自动化控制设备研究所 | 一种惯导/相机安装误差标定方法 |
CN108340371A (zh) * | 2018-01-29 | 2018-07-31 | 珠海市俊凯机械科技有限公司 | 目标跟随点的定位方法以及*** |
CN108340371B (zh) * | 2018-01-29 | 2020-04-21 | 珠海市万瑙特健康科技有限公司 | 目标跟随点的定位方法以及*** |
CN109974713A (zh) * | 2019-04-26 | 2019-07-05 | 安阳全丰航空植保科技股份有限公司 | 一种基于地表特征群的导航方法及*** |
CN109974713B (zh) * | 2019-04-26 | 2023-04-28 | 安阳全丰航空植保科技股份有限公司 | 一种基于地表特征群的导航方法及*** |
CN110398258A (zh) * | 2019-08-13 | 2019-11-01 | 广州广电计量检测股份有限公司 | 一种惯性导航***的性能测试装置及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103630138A (zh) | 基于摄像机头标定算法的无人机视觉导航方法 | |
CN102928861B (zh) | 机载设备用目标定位方法及装置 | |
CN109911188A (zh) | 非卫星导航定位环境的桥梁检测无人机*** | |
WO2019071916A1 (zh) | 天线波束姿态控制方法和*** | |
CN106352872B (zh) | 一种无人机自主导航***及其导航方法 | |
CN106226780A (zh) | 基于激光扫描雷达的多旋翼室内定位***及实现方法 | |
CN102508277A (zh) | 精密单点定位与惯性测量紧组合导航***及数据处理方法 | |
CN102788579A (zh) | 基于sift算法的无人机视觉导航方法 | |
CN109506660B (zh) | 一种用于仿生导航的姿态最优化解算方法 | |
CN101846734A (zh) | 农用机械导航定位方法、***及农用机械工控机 | |
CN102288170A (zh) | 一种水下航行器内电子罗盘的校正方法 | |
CN109032153A (zh) | 基于光电-惯性组合导引的无人机自主着舰方法和*** | |
CN109471447A (zh) | 无人机导航方法、装置、无人机和数据可读存储装置 | |
CN103644917B (zh) | 移动测量平台激光雷达旋转与平移参数计算方法 | |
CN103697885A (zh) | 自动补偿磁偏角的远程定位方法 | |
CN103335654A (zh) | 一种行星动力下降段的自主导航方法 | |
Yang et al. | Multi-sensor data fusion for UAV navigation during landing operations | |
CN104359482A (zh) | 基于lk光流算法的视觉导航方法 | |
CN104316057A (zh) | 一种无人机视觉导航方法 | |
Labowski et al. | Motion compensation for unmanned aerial vehicle's synthetic aperture radar | |
CN109508040A (zh) | 一种无人机精准定位降落***及方法 | |
CN113794497A (zh) | 一种具有抗干扰定位功能的移动卫星通信天线终端 | |
Pan et al. | An optical flow-based integrated navigation system inspired by insect vision | |
Pei et al. | Methods for monitoring and controlling multi-rotor micro-UAVs position and orientation based on LabVIEW | |
CN104749600A (zh) | 一种基于偏振光的判定式组合导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20140312 |
|
WD01 | Invention patent application deemed withdrawn after publication |