CN108845335A - 一种基于图像和导航信息的无人机地面目标定位方法 - Google Patents
一种基于图像和导航信息的无人机地面目标定位方法 Download PDFInfo
- Publication number
- CN108845335A CN108845335A CN201810424196.5A CN201810424196A CN108845335A CN 108845335 A CN108845335 A CN 108845335A CN 201810424196 A CN201810424196 A CN 201810424196A CN 108845335 A CN108845335 A CN 108845335A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- image
- camera
- target
- world coordinate
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/02—Picture taking arrangements specially adapted for photogrammetry or photographic surveying, e.g. controlling overlapping of pictures
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Multimedia (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明属于无人机对地面目标定位领域,具体涉及一种基于图像和导航信息的无人机地面目标定位方法。该方法包括以下步骤:(S1)通过无人机上携带的摄像机获取地面目标的图像,GPS获取无人机当前高度,导航系统获取欧拉角;(S2)建立摄像机坐标系、世界坐标系和图像坐标系,并确定三个坐标系之间的关系;(S3)计算地面目标在世界坐标系中的空间位置。本发明通过无人机导航信息以及摄像机的内外参数,根据目标在图像中的检测结果,获取地面目标的三维空间位置,本发明方法克服了目标远近、目标大小的约束,以及对成像图像精度的要求,在目标定位领域具有较好的通用性。
Description
技术领域
本发明属于无人机对地面目标定位领域,具体涉及一种基于图像和导航信息的无人机地面目标定位方法。
背景技术
随着低成本小型无人机的发展,携带不同载荷来执行不同任务已经越来越受到重视,其中通过携带低成本的摄像机来执行对地面目标的定位就是其中的一个难点。目前常用的目标定位方法是基于合作性质的目标定位,比如已知目标的实际物理尺寸,通过图像的四个点来解算目标的相对位置,该方法要求定位的目标为近目标而且对应成像点检测精度要高,从通用性的角度需要一种非合作式的地面目标定位方法。
发明内容
为解决上述技术问题,本发明结合无人机自身携带的导航信息(位置和姿态)以及摄像机的内外参数,根据目标在图像中的检测结果,获取地面目标的三维空间位置。具体技术方案如下:
一种基于图像和导航信息的无人机地面目标定位方法,包括以下步骤:
(S1)通过无人机上携带的摄像机获取地面目标的图像,GPS(Global PositioningSystem,全球定位系统,缩写GPS)获取无人机当前高度,导航系统获取无人机的欧拉角;
(S2)建立摄像机坐标系、世界坐标系和图像坐标系,确定三个坐标系之间的关系,其中世界坐标系owxwywzw的原点为无人机的起飞点,坐标轴owxw、owyw、owzw分别指向东、北、天;图像坐标系o0uv的原点为图像左上角点,坐标轴u和坐标轴v分别是图像所在的行和列;摄像机坐标系ocxcyczc原点为摄像机光心,ocxc轴和ocyc轴分别与图像坐标系u、v轴平行,oczc轴为摄像机光轴;
(S3)计算地面目标在世界坐标系中的空间位置。
优选地,所述步骤(S3)的具体过程为:
表示摄像机中心相对无人机中心的位移,表示无人机在世界坐标系的位置,表示目标距离摄像机坐标系原点的距离在世界坐标系中的投影,(xw,yw,zw)表示地面目标在世界坐标系中的空间位置坐标值。
优选地,所述地面目标与摄像机坐标系原点的距离在世界坐标系中的投影根据下式进行计算:
其中,(x′w,y′w,z′w)表示地面目标与摄像机坐标系原点之间距离在世界坐标系中的投影坐标,hw表示无人机当前高度(此处的高度为相对于地面的高度),fx、fy分别为摄像机在ocxc和ocyc方向的有效焦距,(u0,v0)为图像主点;zc为目标在摄像机坐标系中的投影坐标在zc方向的值;地面目标在图像坐标系中的坐标为(u1,v1);
其中为对应的欧拉角,为偏航角,θ为俯仰角和为滚转角。
采用本发明获得的有益效果:本发明通过无人机导航信息以及摄像机的内外参数,根据目标在图像中的检测结果,获取地面目标的三维空间位置,本发明方法克服了目标远近、目标大小的约束,以及对成像图像精度的要求,在目标定位领域具有较好的通用性。
附图说明
图1为本发明地面目标定位示意图;
图2为三种坐标系之间的关系示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步说明,以使本发明的优点和特征能更易于被本领域技术人员理解,从而对本发明的保护范围做出更为清楚明确的界定。结合图1,本发明方法具体步骤如下:
(S1)无人机搭载的摄像机对地面目标A进行图像拍摄,无人机上的GPS测量获取无人机当前高度,无人机导航系统获取欧拉角;欧拉角是在世界坐标系下的测量角度。
(S2)如图2所示,建立摄像机坐标系、世界坐标系和图像坐标系,确定三个坐标系之间的关系,其中世界坐标系owxwywzw的原点P为无人机的起飞点,坐标轴owxw、owyw、owzw分别指向东、北、天;图像坐标系o0uv的原点为图像左上角点o0,坐标轴u和坐标轴v分别是图像所在的行和列,图像中心主点为(u0,v0),p为空间点P在图像坐标系中成像点;摄像机坐标系ocxcyczc原点为摄像机光心,ocxc轴和ocyc轴分别与图像坐标系u、v轴平行,oczc轴为摄像机光轴,摄像机焦距为f,ocxc和ocyc方向的有效焦距分别为fx和fy;
摄像机坐标系相对世界坐标系的旋转矩阵表示如下:
其中为对应的欧拉角,偏航角,θ俯仰角和滚转角。
(S3)计算地面目标在世界坐标系中的空间位置。
如图1所示,A为地面目标的物理中心点,摄像机中心为oc,无人机机体中心为o1,一般来说o1和oc不在同一点,因此地面目标A在世界坐标系中的空间位置(xw,yw,zw)为:
其中摄像机中心相对无人机中心的位移为且事先已经标定;无人机在世界坐标系的位置可以由无人机的导航系统信息获得。因此要获得(xw,yw,zw),需求解出地面目标距离摄像机原点的距离在世界坐标系中的投影(x′w,y′w,z′w),即
假设地面目标A在图像坐标系中的坐标为(u1,v1),有效焦距分别为fx和fy,则A在摄像机坐标系的投影(xc1,yc1,zc1)表示如下:
h(u1,v1)表示在在摄像机坐标系的投影。
进一步获得目标A距离摄像机原点的距离在世界坐标系中的投影(x′w,y′w,z′w)表达式:
由于z′w默认取值为无人机当前的高度,即z′w=hw,且高度hw通过无人机携带的GPS等传感器测量获得,对上式进行整理,方程组可以写成如下形式:
求解获得唯一解(xw',yw',zc1)
进一步获得地面目标距离摄像机原点的距离在世界坐标系中的投影:
最终,根据公式(2)和公式(7)可求得地面目标A在世界坐标系中的空间位置(xw,yw,zw)。
上述实例只是用于对本发明的解释,而不能作为对本发明的限制,因此凡是与本发明设计思路相同的实施方式均在本发明的保护范围内。
Claims (3)
1.一种基于图像和导航信息的无人机地面目标定位方法,其特征在于,包括以下步骤:
(S1)通过无人机上携带的摄像机获取地面目标的图像,GPS获取无人机当前高度,导航系统获取欧拉角;
(S2)建立摄像机坐标系、世界坐标系和图像坐标系,并确定三个坐标系之间的关系,其中世界坐标系owxwywzw的原点为无人机的起飞点,坐标轴owxw、owyw、owzw分别指向东、北、天;图像坐标系o0uv的原点为图像左上角点,坐标轴u和坐标轴v分别是图像所在的行和列;摄像机坐标系ocxcyczc原点为摄像机光心,ocxc和ocyc轴与图像坐标系u、v轴平行,oczc轴为摄像机光轴;
(S3)计算地面目标在世界坐标系中的空间位置。
2.如权利要求1所一种基于图像和导航信息的无人机地面目标定位方法,其特征在于,所述步骤(S3)的具体过程为:
表示摄像机中心相对无人机中心的位移,表示无人机在世界坐标系的位置,表示地面目标距离摄像机坐标系原点的距离在世界坐标系中的投影,表示摄像机坐标系相对世界坐标系的旋转矩阵,(xw,yw,zw)表示地面目标在世界坐标系中的空间位置坐标值。
3.如权利要求2所一种基于图像和导航信息的无人机地面目标定位方法,其特征在于,所述地面目标与摄像机坐标系原点的距离在世界坐标系中的投影根据下式进行计算:
其中,(x′w,y′w,z′w)表示目标与摄像机坐标系原点之间距离在世界坐标系中的投影坐标,hw表示无人机当前高度,fx、fy分别为摄像机在ocxc和ocyc方向的有效焦距,(u0,v0)为图像主点;zc1为目标在摄像机坐标系中的投影坐标在zc方向的值;地面目标在图像坐标系中的坐标为(u1,v1);
其中(ψ,θ,φ)为对应的欧拉角,ψ为偏航角,θ为俯仰角和φ为滚转角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810424196.5A CN108845335A (zh) | 2018-05-07 | 2018-05-07 | 一种基于图像和导航信息的无人机地面目标定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810424196.5A CN108845335A (zh) | 2018-05-07 | 2018-05-07 | 一种基于图像和导航信息的无人机地面目标定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108845335A true CN108845335A (zh) | 2018-11-20 |
Family
ID=64212677
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810424196.5A Pending CN108845335A (zh) | 2018-05-07 | 2018-05-07 | 一种基于图像和导航信息的无人机地面目标定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108845335A (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109660721A (zh) * | 2018-12-14 | 2019-04-19 | 上海扩博智能技术有限公司 | 无人机飞行拍摄质量优化方法、系统、设备及存储介质 |
CN109974713A (zh) * | 2019-04-26 | 2019-07-05 | 安阳全丰航空植保科技股份有限公司 | 一种基于地表特征群的导航方法及系统 |
CN109974688A (zh) * | 2019-03-06 | 2019-07-05 | 深圳飞马机器人科技有限公司 | 通过无人机定位的方法及终端 |
CN110503687A (zh) * | 2019-08-12 | 2019-11-26 | 中国科学院光电技术研究所 | 一种空中光电测量平台目标定位方法 |
CN110887461A (zh) * | 2019-11-19 | 2020-03-17 | 西北工业大学 | 基于gps姿态估计的无人机实时计算机视觉处理方法 |
CN111247389A (zh) * | 2019-03-29 | 2020-06-05 | 深圳市大疆创新科技有限公司 | 关于拍摄设备的数据处理方法、装置及图像处理设备 |
RU2726902C1 (ru) * | 2020-01-21 | 2020-07-16 | Открытое акционерное общество "Радиоавионика" | Способ определения координат наземных объектов при фотосъёмке с беспилотного летательного аппарата |
CN111457895A (zh) * | 2020-03-31 | 2020-07-28 | 彩虹无人机科技有限公司 | 一种无人机光电载荷的目标尺寸计算与显示方法 |
CN111583339A (zh) * | 2020-04-27 | 2020-08-25 | 中国人民解放军军事科学院国防科技创新研究院 | 获取目标位置的方法、装置、电子设备及介质 |
CN112149505A (zh) * | 2020-08-25 | 2020-12-29 | 合肥工业大学 | 基于图像的无人机自主地面污染物定位方法及系统 |
CN112149507A (zh) * | 2020-08-25 | 2020-12-29 | 合肥工业大学 | 基于图像的无人机自主地面污染物推理与定位方法及系统 |
CN113311873A (zh) * | 2021-05-07 | 2021-08-27 | 中国科学院沈阳自动化研究所 | 一种基于视觉的无人机伺服跟踪方法 |
CN114355378A (zh) * | 2022-03-08 | 2022-04-15 | 天津云圣智能科技有限责任公司 | 无人机的自主导航方法、装置、无人机及存储介质 |
CN114494423A (zh) * | 2022-04-07 | 2022-05-13 | 中国科学院地理科学与资源研究所 | 一种无人平台载荷非中心目标经纬度定位方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101038163A (zh) * | 2007-02-07 | 2007-09-19 | 北京航空航天大学 | 可变焦摄像机空间三维位姿的单视测量方法 |
CN102313536A (zh) * | 2011-07-21 | 2012-01-11 | 清华大学 | 基于机载双目视觉的障碍物感知方法 |
CN105353772A (zh) * | 2015-11-16 | 2016-02-24 | 中国航天时代电子公司 | 一种无人机机动目标定位跟踪中的视觉伺服控制方法 |
US20170355458A1 (en) * | 2016-06-09 | 2017-12-14 | Skycatch, Inc. | Identifying camera position of a uav in flight utilizing real time kinematic satellite navigation |
CN107918397A (zh) * | 2016-10-05 | 2018-04-17 | 鹦鹉无人机股份有限公司 | 带目标跟踪和拍摄角保持的无人机移动图像自主拍摄系统 |
CN207263134U (zh) * | 2017-10-17 | 2018-04-20 | 天津飞眼无人机科技有限公司 | 一种基于无人机的土地面积测量系统 |
-
2018
- 2018-05-07 CN CN201810424196.5A patent/CN108845335A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101038163A (zh) * | 2007-02-07 | 2007-09-19 | 北京航空航天大学 | 可变焦摄像机空间三维位姿的单视测量方法 |
CN102313536A (zh) * | 2011-07-21 | 2012-01-11 | 清华大学 | 基于机载双目视觉的障碍物感知方法 |
CN105353772A (zh) * | 2015-11-16 | 2016-02-24 | 中国航天时代电子公司 | 一种无人机机动目标定位跟踪中的视觉伺服控制方法 |
US20170355458A1 (en) * | 2016-06-09 | 2017-12-14 | Skycatch, Inc. | Identifying camera position of a uav in flight utilizing real time kinematic satellite navigation |
CN107918397A (zh) * | 2016-10-05 | 2018-04-17 | 鹦鹉无人机股份有限公司 | 带目标跟踪和拍摄角保持的无人机移动图像自主拍摄系统 |
CN207263134U (zh) * | 2017-10-17 | 2018-04-20 | 天津飞眼无人机科技有限公司 | 一种基于无人机的土地面积测量系统 |
Non-Patent Citations (3)
Title |
---|
孙水发等: "《3D打印逆向建模技术及应用》", 31 May 2016, 南京师范大学出版社 * |
徐德等: "《机器人视觉测量与控制》", 31 January 2016, 国防工业出版社 * |
谢辉: "《无人机应用基础》", 28 February 2018 * |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109660721A (zh) * | 2018-12-14 | 2019-04-19 | 上海扩博智能技术有限公司 | 无人机飞行拍摄质量优化方法、系统、设备及存储介质 |
CN109974688A (zh) * | 2019-03-06 | 2019-07-05 | 深圳飞马机器人科技有限公司 | 通过无人机定位的方法及终端 |
CN111247389A (zh) * | 2019-03-29 | 2020-06-05 | 深圳市大疆创新科技有限公司 | 关于拍摄设备的数据处理方法、装置及图像处理设备 |
CN109974713A (zh) * | 2019-04-26 | 2019-07-05 | 安阳全丰航空植保科技股份有限公司 | 一种基于地表特征群的导航方法及系统 |
CN109974713B (zh) * | 2019-04-26 | 2023-04-28 | 安阳全丰航空植保科技股份有限公司 | 一种基于地表特征群的导航方法及系统 |
CN110503687A (zh) * | 2019-08-12 | 2019-11-26 | 中国科学院光电技术研究所 | 一种空中光电测量平台目标定位方法 |
CN110503687B (zh) * | 2019-08-12 | 2022-09-20 | 中国科学院光电技术研究所 | 一种空中光电测量平台目标定位方法 |
CN110887461A (zh) * | 2019-11-19 | 2020-03-17 | 西北工业大学 | 基于gps姿态估计的无人机实时计算机视觉处理方法 |
CN110887461B (zh) * | 2019-11-19 | 2021-04-06 | 西北工业大学 | 基于gps姿态估计的无人机实时计算机视觉处理方法 |
RU2726902C1 (ru) * | 2020-01-21 | 2020-07-16 | Открытое акционерное общество "Радиоавионика" | Способ определения координат наземных объектов при фотосъёмке с беспилотного летательного аппарата |
CN111457895A (zh) * | 2020-03-31 | 2020-07-28 | 彩虹无人机科技有限公司 | 一种无人机光电载荷的目标尺寸计算与显示方法 |
CN111457895B (zh) * | 2020-03-31 | 2022-04-22 | 彩虹无人机科技有限公司 | 一种无人机光电载荷的目标尺寸计算与显示方法 |
CN111583339A (zh) * | 2020-04-27 | 2020-08-25 | 中国人民解放军军事科学院国防科技创新研究院 | 获取目标位置的方法、装置、电子设备及介质 |
CN112149507A (zh) * | 2020-08-25 | 2020-12-29 | 合肥工业大学 | 基于图像的无人机自主地面污染物推理与定位方法及系统 |
CN112149507B (zh) * | 2020-08-25 | 2023-01-13 | 合肥工业大学 | 基于图像的无人机自主地面污染物推理与定位方法及系统 |
CN112149505B (zh) * | 2020-08-25 | 2023-01-13 | 合肥工业大学 | 基于图像的无人机自主地面污染物定位方法及系统 |
CN112149505A (zh) * | 2020-08-25 | 2020-12-29 | 合肥工业大学 | 基于图像的无人机自主地面污染物定位方法及系统 |
CN113311873A (zh) * | 2021-05-07 | 2021-08-27 | 中国科学院沈阳自动化研究所 | 一种基于视觉的无人机伺服跟踪方法 |
CN114355378A (zh) * | 2022-03-08 | 2022-04-15 | 天津云圣智能科技有限责任公司 | 无人机的自主导航方法、装置、无人机及存储介质 |
CN114494423A (zh) * | 2022-04-07 | 2022-05-13 | 中国科学院地理科学与资源研究所 | 一种无人平台载荷非中心目标经纬度定位方法及系统 |
CN114494423B (zh) * | 2022-04-07 | 2022-06-28 | 中国科学院地理科学与资源研究所 | 一种无人平台载荷非中心目标经纬度定位方法及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108845335A (zh) | 一种基于图像和导航信息的无人机地面目标定位方法 | |
CN107862719B (zh) | 相机外参的标定方法、装置、计算机设备和存储介质 | |
CN105021184B (zh) | 一种用于移动平台下视觉着舰导航的位姿估计系统及方法 | |
CN101598556B (zh) | 一种未知环境下无人机视觉/惯性组合导航方法 | |
CN106500731B (zh) | 一种基于恒星模拟系统的船载经纬仪的标校方法 | |
CN108665499B (zh) | 一种基于视差法的近距飞机位姿测量方法 | |
CN107728182B (zh) | 基于相机辅助的柔性多基线测量方法和装置 | |
US20110282580A1 (en) | Method of image based navigation for precision guidance and landing | |
CN101216937B (zh) | 港口运动集装箱定位系统的参数标定方法 | |
CN103822644B (zh) | 一种三维激光成像系统的相机标定方法 | |
CN108375383B (zh) | 多相机辅助的机载分布式pos柔性基线测量方法和装置 | |
CN108663043B (zh) | 基于单个相机辅助的分布式pos主子节点相对位姿测量方法 | |
CN115187798A (zh) | 一种多无人机高精度匹配定位方法 | |
CN107677274A (zh) | 基于双目视觉的无人机自主着陆导航信息实时解算方法 | |
CN106500699B (zh) | 一种适用于无人机室内自主降落的位姿估计方法 | |
CN109978954A (zh) | 基于箱体的雷达和相机联合标定的方法和装置 | |
CN111504323A (zh) | 基于异源图像匹配与惯性导航融合的无人机自主定位方法 | |
WO2021143664A1 (zh) | 在载运工具中测量目标对象距离的方法、装置和载运工具 | |
CN110542407A (zh) | 一种航拍图像任意像素点定位信息获取方法 | |
Yu et al. | Full-parameter vision navigation based on scene matching for aircrafts | |
Zhang et al. | Autonomous landing on ground target of UAV by using image-based visual servo control | |
CN114777768A (zh) | 一种卫星拒止环境高精度定位方法、系统及电子设备 | |
CN109146936B (zh) | 一种图像匹配方法、装置、定位方法及系统 | |
CN113340272B (zh) | 一种基于无人机微群的地面目标实时定位方法 | |
CN112577463B (zh) | 姿态参数修正的航天器单目视觉测距方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20181120 |