CN107314771A - 基于编码标志点的无人机定位以及姿态角测量方法 - Google Patents

基于编码标志点的无人机定位以及姿态角测量方法 Download PDF

Info

Publication number
CN107314771A
CN107314771A CN201710538621.9A CN201710538621A CN107314771A CN 107314771 A CN107314771 A CN 107314771A CN 201710538621 A CN201710538621 A CN 201710538621A CN 107314771 A CN107314771 A CN 107314771A
Authority
CN
China
Prior art keywords
mrow
mtd
mtr
unmanned plane
coordinate system
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.)
Granted
Application number
CN201710538621.9A
Other languages
English (en)
Other versions
CN107314771B (zh
Inventor
张进
任丽君
邓华夏
于连栋
马孟超
钟翔
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hefei University of Technology
Original Assignee
Hefei University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hefei University of Technology filed Critical Hefei University of Technology
Priority to CN201710538621.9A priority Critical patent/CN107314771B/zh
Publication of CN107314771A publication Critical patent/CN107314771A/zh
Application granted granted Critical
Publication of CN107314771B publication Critical patent/CN107314771B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P13/00Indicating or recording presence, absence, or direction, of movement
    • G01P13/02Indicating direction only, e.g. by weather vane
    • G01P13/025Indicating direction only, e.g. by weather vane indicating air data, i.e. flight variables of an aircraft, e.g. angle of attack, side slip, shear, yaw

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Navigation (AREA)
  • Image Analysis (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本发明提供一种基于编码合作点的无人机定位以及姿态角测量方法,包括如下步骤:用搭载在无人机上的相机拍摄地面上预先布置的若干编码标志点,获取拍摄图像,并进行处理;对搭载在无人机上的相机进行标定,获得相机的内参数;求取世界坐标系相对于相机坐标系的旋转矩阵和平移矩阵,无人机坐标系相对于相机坐标系的旋转矩阵和平移矩阵,无人机坐标系相对于世界坐标系的旋转矩阵和平移矩阵;并据此计算无人机的姿态角,包括俯仰角、偏航角以及翻滚角以及无人机在世界坐标系下的位置坐标。本发明采用带初始点的二进制编码合作点,结合无人机坐标系,相机坐标系,世界坐标系三坐标之间的坐标转换关系,算法简单易于实现,同时也满足了精度要求。

Description

基于编码标志点的无人机定位以及姿态角测量方法
技术领域
本发明属于近景摄影测量以及机器视觉技术领域,具体涉及一种基于编码标志点的无人机定位以及姿态角测量方法。
背景技术
无人机的姿态测量技术在军事试验、航天对接、航空摄影、航海地形、工业测量等领域有着十分重要的地位,越来越多专家学者开始对无人机的姿态角测量展开了深入探讨与研究。其中姿态角是反映飞行器运动状态的重要参数,获得这些参数对飞行器的运动分析、气动参量辨识、优化设计、故障分析等有着重要的意义。无人机姿态角测量在无人机着舰,以及导航方面要求精确度极高,出现问题可能造成不可挽回的损失,无人机姿态角的测量日益彰显出极大的重要作用。随着视觉测量、图像处理、计算机技术等技术的不断成熟和完善,计算机视觉测量方法也获得了快速发展,测量更加快速、精确,视觉***具有轻便、低功耗、体积小、精度高,不受电子干扰等优点,此外,视觉导航还具有很高的隐蔽性。视觉***是无人机***的重要组成部分,根据视觉***求取无人机姿态角逐渐成为发展趋势。
现存的基于视觉的无人机姿态角测量大多采取的是基于合作物的测量。如一种无人机定位的方法,该方法为:在无人机到达位于目标位置点的预设距离范围内的位置点之后,根据预设的图像采集参数,采集用预设标志物进行标记的所述目标位置点的图像。提取所述图像的特征信息,将所述特征信息与预存储特征信息进行比对,判断是否一致。当一致时,根据当前的所述图像采集参数,计算出所述位置点和所述目标位置点之间的距离。但是,该方法存在一定的局限性,当无人机不在目标范围内时,就无法实现无人机定位;并且,需要采集标志点和预存储的特征信息进行对比判断,从而得到无人机位置信息,这个过程耗时较长,不能快速得到无人机的位置信息。因此,设计一种没有特殊飞行位置限制,又能快速得出无人机位置坐标以及其他信息的方法具有较大的意义和研究价值。
发明内容
为了解决现有的的上述技术缺陷,本发明提供一种基于编码标志点的无人机定位以及姿态角测量方法。
本发明是通过以下技术方案实现的:
基于编码标志点的无人机定位以及姿态角测量方法,包括如下步骤:
用搭载在无人机上的相机拍摄地面上预先布置的若干编码标志点,获取拍摄图像,并进行处理;编码标志点为带初始点的二进制编码合作点;
对搭载在无人机上的相机进行标定,获得相机的内参数;
求取世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c
根据三维坐标转换关系计算无人机坐标系相对于相机坐标系的旋转矩阵Ra2c和平移矩阵Ta2c
根据世界坐标系相对于相机坐标系的旋转矩阵Rw2c以及无人机坐标系相对于相机坐标系的旋转矩阵Ra2c计算无人机坐标系相对于世界坐标系的旋转矩阵Ra2w;根据世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c以及无人机坐标系相对于相机坐标系的平移矩阵Ta2c计算无人机坐标系相对于世界坐标系的平移矩阵Ta2w
根据无人机坐标系相对于世界坐标系的旋转矩阵Ra2w,计算无人机的姿态角,包括俯仰角、偏航角以及翻滚角;根据无人机坐标系相对于世界坐标系的平移矩阵Ta2w,计算无人机在世界坐标系下的位置坐标。
本发明相对于现有技术的有益效果在于:
1.本发明采用带初始点的二进制编码合作点,在很大程度上扩大了无人机拍摄标识点的视场范围,增强了无人机定位以及姿态角测量的灵活性以及可行性,使得无人机的定位以及姿态角的测量精度明显提高,且易于制作。
2.本发明根据无人机坐标系,相机坐标系,世界坐标系三坐标之间的坐标转换关系,计算出无人机相对世界坐标系的位置坐标以及在世界坐标系下的姿态角,使无人机定位以及姿态角的测量速度进一步提高,算法简单易于实现,有效的增强了该算法的实时性。3.本发明不仅解决了无人机的搭载质量限制问题,也满足了精度要求。
附图说明
图1为基于编码标志点的无人机定位以及姿态角测量方法的总流程图;
图2为带起始点的二进制编码标志点的示意图;
图3为无人机对地拍摄过程的示意图;
图4为无人机坐标系到相机坐标系之间的关系图;
图5为任意拍摄到四个编码标志点的示意图;
图6为任意拍摄到五个编码标志点的示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施方式仅仅用以解释本发明,并不用于限定本发明。
实施例1:
实现本发明所需的无人机须满足以下要求:搭载高速相机,相机能够对地面对地面进行拍摄,并能够将拍摄到的图像传输到地面实验平台进行处理。
下面具体说明本实施例提供的基于编码标志点的无人机定位以及姿态角测量方法,如图1所示,包括如下步骤:
步骤S1,用搭载在无人机上的相机拍摄地面上预先布置的若干编码标志点,获取拍摄图像,并进行处理;编码标志点为带初始点的二进制编码合作点,如图1所示。拍摄过程示意图如图3所示。
本步骤中提到的图像处理方法具体为获取拍摄到图像上的任意若干个编码标志点,并对获取的编码标志点解码匹配。获取编码标志点的数量可根据步骤S3中使用的求取世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c的方法确定,若采用直接线性法,需要至少获取四个编码标志点;若采用Tsai两步标定法,需要至少获取五个编码标志点。
具体的编码标志点的形状、结构设置以及解码方法可以参考申请号为201611108392.9的中国发明专利申请说明书第31至53段。
步骤S2,对无人机的相机进行标定,获得相机的内参数。
在本实施例中,利用张正友的棋盘格标定相机,得到相机的内参数,内参数具体包括:主点坐标(u0,v0),焦距f,等效焦距Fx,Fy,径向畸变参数K1,K2,K3,切向畸变参数P1,P2。
步骤S3,求取世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c
可以根据直接线性法或Tsai两步标定法计算世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c。若采用直接线性法,需要保证相机至少任意拍摄到四个编码标志点,如图5所示;若采用Tsai两步标定法,需要保证相机至少任意拍摄到五个编码标志点,如图6所示。
本实施例以直接线性法为例进行说明:
根据直接线性法计算世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c,具体步骤如下:
根据公式(1)所示的世界坐标系相对于像素坐标系之间的关系,公式(2)所示的平面中心透视投影矩阵,得到公式(3)所示的平面中心透视投影关系式;
并根据平面中心透视投影关系式计算世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c
步骤S4,根据三维坐标转换关系计算无人机坐标系相对于相机坐标系的旋转矩阵Ra2c和平移矩阵Ta2c
无人机坐标系相对于相机坐标系之间的关系图如图4所示,计算无人机坐标系相对于相机坐标系的旋转矩阵Ra2c和平移矩阵Ta2c的具体步骤如下:
设无人机坐标系X轴与相机坐标系X’轴之间的夹角为90°,无人机坐标系Y轴与相机坐标系Y’轴之间的夹角为90°,无人机坐标系Z轴与相机坐标系Z’轴之间的夹角为180°;根据公式(4)和(5)计算得到无人机坐标系相对于相机坐标系的旋转矩阵Ra2c和平移矩阵Ta2c
Ta2c=[0,0,-h](5)
其中,h为相机坐标系原点到无人机坐标系原点的距离。
步骤S5,根据世界坐标系相对于相机坐标系的旋转矩阵Rw2c以及无人机坐标系相对于相机坐标系的旋转矩阵Ra2c计算无人机坐标系相对于世界坐标系的旋转矩阵Ra2w;根据世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c以及无人机坐标系相对于相机坐标系的平移矩阵Ta2c计算无人机坐标系相对于世界坐标系的平移矩阵Ta2w
根据公式(6)计算无人机坐标系相对于世界坐标系的旋转矩阵Ra2w
根据公式(7)计算无人机坐标系相对于世界坐标系的平移矩阵Ta2w
步骤S6,根据无人机坐标系相对于世界坐标系的旋转矩阵Ra2w,计算无人机的姿态角,包括俯仰角、偏航角以及翻滚角;根据无人机坐标系相对于世界坐标系的平移矩阵Ta2w,计算无人机在世界坐标系下的位置坐标。
无人机坐标系相对于世界坐标系的旋转矩阵Ra2w如公式(8)所示:
根据公式(9)计算俯仰角b;
b=arcsin(-r2) (9)
根据公式(10)计算偏航角c;
根据公式(11)计算翻滚角a;
根据公式(12)计算无人机在世界坐标系下的位置坐标Oa
Oa=Ta2w (12)。
本领域的技术人员容易理解,以上仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

Claims (7)

1.一种基于编码标志点的无人机定位以及姿态角测量方法,其特征在于,包括如下步骤:用所述搭载在无人机上的相机拍摄地面上预先布置的若干编码标志点,获取拍摄图像,并进行处理;所述编码标志点为带初始点的二进制编码合作点;
对所述搭载在无人机上的相机进行标定,获得所述相机的内参数;
求取世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c
根据三维坐标转换关系计算无人机坐标系相对于相机坐标系的旋转矩阵Ra2c和平移矩阵Ta2c
根据世界坐标系相对于相机坐标系的旋转矩阵Rw2c以及无人机坐标系相对于相机坐标系的旋转矩阵Ra2c计算无人机坐标系相对于世界坐标系的旋转矩阵Ra2w;根据世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c以及无人机坐标系相对于相机坐标系的平移矩阵Ta2c计算无人机坐标系相对于世界坐标系的平移矩阵Ta2w
根据无人机坐标系相对于世界坐标系的旋转矩阵Ra2w,计算无人机的姿态角,包括俯仰角、偏航角以及翻滚角;根据无人机坐标系相对于世界坐标系的平移矩阵Ta2w,计算无人机在世界坐标系下的位置坐标。
2.根据权利要求1所述的基于编码标志点的无人机定位以及姿态角测量方法,其特征在于,所述内参数包括:
主点坐标(u0,v0),焦距f,等效焦距Fx,Fy,径向畸变参数K1,K2,K3,切向畸变参数P1,P2。
3.根据权利要求1所述的基于编码标志点的无人机定位以及姿态角测量方法,其特征在于,根据直接线性法或Tsai两步标定法计算所述世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c
4.根据权利要求3所述的基于编码标志点的无人机定位以及姿态角测量方法,其特征在于,根据直接线性法计算所述世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c,具体步骤如下:
根据公式(1)所示的世界坐标系相对于像素坐标系之间的关系,公式(2)所示的平面中心透视投影矩阵,得到公式(3)所示的平面中心透视投影关系式;
<mrow> <mi>&amp;lambda;</mi> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mi>u</mi> </mtd> </mtr> <mtr> <mtd> <mi>v</mi> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>F</mi> <mi>x</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>u</mi> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>F</mi> <mi>y</mi> </mrow> </mtd> <mtd> <mrow> <mi>v</mi> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> <mo>*</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <mrow> <mi>r</mi> <mn>0</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </mtd> <mtd> <mrow> <mi>T</mi> <mi>x</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>r</mi> <mn>3</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>4</mn> </mrow> </mtd> <mtd> <mrow> <mi>T</mi> <mi>y</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>r</mi> <mn>6</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>7</mn> </mrow> </mtd> <mtd> <mrow> <mi>T</mi> <mi>z</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>*</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>X</mi> <mi>w</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>Y</mi> <mi>w</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>M</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>m</mi> <mn>0</mn> </mrow> </mtd> <mtd> <mrow> <mi>m</mi> <mn>1</mn> </mrow> </mtd> <mtd> <mrow> <mi>m</mi> <mn>3</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>m</mi> <mn>4</mn> </mrow> </mtd> <mtd> <mrow> <mi>m</mi> <mn>5</mn> </mrow> </mtd> <mtd> <mrow> <mi>m</mi> <mn>7</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>m</mi> <mn>8</mn> </mrow> </mtd> <mtd> <mrow> <mi>m</mi> <mn>9</mn> </mrow> </mtd> <mtd> <mrow> <mi>m</mi> <mn>11</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>F</mi> <mi>x</mi> <mi>r</mi> <mn>0</mn> <mo>+</mo> <mi>u</mi> <mn>0</mn> <mi>r</mi> <mn>7</mn> </mrow> </mtd> <mtd> <mrow> <mi>F</mi> <mi>x</mi> <mi>r</mi> <mn>1</mn> <mo>+</mo> <mi>u</mi> <mn>0</mn> <mi>r</mi> <mn>7</mn> </mrow> </mtd> <mtd> <mrow> <mi>F</mi> <mi>x</mi> <mi>T</mi> <mi>x</mi> <mo>+</mo> <mi>u</mi> <mn>0</mn> <mi>T</mi> <mi>z</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>F</mi> <mi>y</mi> <mi>r</mi> <mn>3</mn> <mo>+</mo> <mi>v</mi> <mn>0</mn> <mi>r</mi> <mn>6</mn> </mrow> </mtd> <mtd> <mrow> <mi>F</mi> <mi>y</mi> <mi>r</mi> <mn>4</mn> <mo>+</mo> <mi>v</mi> <mn>0</mn> <mi>r</mi> <mn>7</mn> </mrow> </mtd> <mtd> <mrow> <mi>F</mi> <mi>y</mi> <mi>T</mi> <mi>y</mi> <mo>+</mo> <mi>v</mi> <mn>0</mn> <mi>T</mi> <mi>z</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>r</mi> <mn>6</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>7</mn> </mrow> </mtd> <mtd> <mrow> <mi>T</mi> <mi>z</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>m</mi> <mn>0</mn> <msub> <mi>X</mi> <mi>i</mi> </msub> <mo>+</mo> <mi>m</mi> <mn>1</mn> <msub> <mi>Y</mi> <mi>i</mi> </msub> <mo>+</mo> <mi>m</mi> <mn>3</mn> <mo>-</mo> <mi>m</mi> <mn>8</mn> <msub> <mi>uX</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>m</mi> <mn>9</mn> <msub> <mi>uY</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>m</mi> <mn>11</mn> <mi>u</mi> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>m</mi> <mn>4</mn> <msub> <mi>X</mi> <mi>i</mi> </msub> <mo>+</mo> <mi>m</mi> <mn>5</mn> <msub> <mi>Y</mi> <mi>i</mi> </msub> <mo>+</mo> <mi>m</mi> <mn>7</mn> <mo>-</mo> <mi>m</mi> <mn>8</mn> <msub> <mi>vX</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>m</mi> <mn>9</mn> <msub> <mi>vY</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>m</mi> <mn>11</mn> <mi>v</mi> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
并根据所述平面中心透视投影关系式计算世界坐标系相对于相机坐标系的旋转矩阵Rw2c和平移矩阵Tw2c
5.根据权利要求1所述的基于编码标志点的无人机定位以及姿态角测量方法,其特征在于,所述根据三维坐标转换关系计算无人机坐标系相对于相机坐标系的旋转矩阵Ra2c和平移矩阵Ta2c的具体步骤如下:
设无人机坐标系X轴与相机坐标系X’轴之间的夹角为90°,无人机坐标系Y轴与相机坐标系Y’轴之间的夹角为90°,无人机坐标系Z轴与相机坐标系Z’轴之间的夹角为180°;根据公式(4)和(5)计算得到无人机坐标系相对于相机坐标系的旋转矩阵Ra2c和平移矩阵Ta2c
<mrow> <msub> <mi>R</mi> <mrow> <mi>a</mi> <mn>2</mn> <mi>c</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>R</mi> <mi>x</mi> </msub> <mo>*</mo> <msub> <mi>R</mi> <mi>y</mi> </msub> <mo>*</mo> <msub> <mi>R</mi> <mi>z</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
Ta2c=[0,0,-h] (5)
其中,h为相机坐标系原点到无人机坐标系原点的距离。
6.根据权利要求1所述的基于编码标志点的无人机定位以及姿态角测量方法,其特征在于,根据公式(6)计算无人机坐标系相对于世界坐标系的旋转矩阵Ra2w
<mrow> <msub> <mi>R</mi> <mrow> <mi>a</mi> <mn>2</mn> <mi>w</mi> </mrow> </msub> <mo>=</mo> <msubsup> <mi>R</mi> <mrow> <mi>w</mi> <mn>2</mn> <mi>c</mi> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mo>*</mo> <msub> <mi>R</mi> <mrow> <mi>a</mi> <mn>2</mn> <mi>c</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
根据公式(7)计算无人机坐标系相对于世界坐标系的平移矩阵Ta2w
<mrow> <msub> <mi>T</mi> <mrow> <mi>a</mi> <mn>2</mn> <mi>w</mi> </mrow> </msub> <mo>=</mo> <msubsup> <mi>R</mi> <mrow> <mi>w</mi> <mn>2</mn> <mi>c</mi> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mrow> <mi>a</mi> <mn>2</mn> <mi>c</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>T</mi> <mrow> <mi>w</mi> <mn>2</mn> <mi>c</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> <mo>.</mo> </mrow>
7.根据权利要求1所述的基于编码标志点的无人机定位以及姿态角测量方法,其特征在于,无人机坐标系相对于世界坐标系的旋转矩阵Ra2w如公式(8)所示:
<mrow> <msub> <mi>R</mi> <mrow> <mi>a</mi> <mn>2</mn> <mi>w</mi> </mrow> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>r</mi> <mn>0</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>r</mi> <mn>3</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>4</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>5</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>r</mi> <mn>6</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>7</mn> </mrow> </mtd> <mtd> <mrow> <mi>r</mi> <mn>8</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
根据公式(9)计算俯仰角b;
b=arcsin(-r2) (9)
根据公式(10)计算偏航角c;
<mrow> <mi>c</mi> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mi>c</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mfrac> <mrow> <mi>r</mi> <mn>0</mn> </mrow> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <mi>b</mi> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
根据公式(11)计算翻滚角a;
<mrow> <mi>a</mi> <mo>=</mo> <mi>arcsin</mi> <mfrac> <mrow> <mi>r</mi> <mn>5</mn> </mrow> <mrow> <mi>cos</mi> <mi>b</mi> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
根据公式(12)计算无人机在世界坐标系下的位置坐标Oa
Oa=Ta2w (12)。
CN201710538621.9A 2017-07-04 2017-07-04 基于编码标志点的无人机定位以及姿态角测量方法 Expired - Fee Related CN107314771B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710538621.9A CN107314771B (zh) 2017-07-04 2017-07-04 基于编码标志点的无人机定位以及姿态角测量方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710538621.9A CN107314771B (zh) 2017-07-04 2017-07-04 基于编码标志点的无人机定位以及姿态角测量方法

Publications (2)

Publication Number Publication Date
CN107314771A true CN107314771A (zh) 2017-11-03
CN107314771B CN107314771B (zh) 2020-04-21

Family

ID=60180020

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710538621.9A Expired - Fee Related CN107314771B (zh) 2017-07-04 2017-07-04 基于编码标志点的无人机定位以及姿态角测量方法

Country Status (1)

Country Link
CN (1) CN107314771B (zh)

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107966155A (zh) * 2017-12-25 2018-04-27 北京地平线信息技术有限公司 对象定位方法、对象定位***和电子设备
CN108645408A (zh) * 2018-05-07 2018-10-12 中国人民解放军国防科技大学 一种基于导航信息的无人机自主回收目标预测方法
CN108733066A (zh) * 2018-05-07 2018-11-02 中国人民解放军国防科技大学 一种基于吊舱姿态反馈的目标跟踪控制方法
CN108765494A (zh) * 2018-05-21 2018-11-06 南昌航空大学 一种基于圆柱体标定物的多相机标定方法
CN109141396A (zh) * 2018-07-16 2019-01-04 南京航空航天大学 辅助信息与随机抽样一致算法融合的无人机位姿估计方法
CN109677217A (zh) * 2018-12-27 2019-04-26 魔视智能科技(上海)有限公司 牵引车与挂车偏航角的检测方法
WO2019165612A1 (zh) * 2018-02-28 2019-09-06 深圳市大疆创新科技有限公司 可移动平台的定位方法及相关装置、***
CN110487249A (zh) * 2019-07-17 2019-11-22 广东工业大学 一种用于结构三维振动测量的无人机标定方法
CN110603503A (zh) * 2018-02-28 2019-12-20 深圳市大疆创新科技有限公司 移动设备的控制方法、设备和存储装置
CN111192318A (zh) * 2018-11-15 2020-05-22 杭州海康机器人技术有限公司 确定无人机位置和飞行方向的方法、装置及无人机
CN111247389A (zh) * 2019-03-29 2020-06-05 深圳市大疆创新科技有限公司 关于拍摄设备的数据处理方法、装置及图像处理设备
CN111536984A (zh) * 2020-05-11 2020-08-14 北京百度网讯科技有限公司 定位方法和装置、车端设备、车辆、电子设备和定位***
CN112265463A (zh) * 2020-10-16 2021-01-26 北京猎户星空科技有限公司 自移动设备的控制方法、装置、自移动设备和介质
CN112419403A (zh) * 2020-11-30 2021-02-26 海南大学 一种基于二维码阵列的室内无人机定位方法
CN112507885A (zh) * 2020-12-10 2021-03-16 国网江西省电力有限公司南昌供电分公司 一种巡线无人机识别侵扰的方法
CN112711263A (zh) * 2021-01-19 2021-04-27 未来机器人(深圳)有限公司 仓储自动导引车避障方法、装置、计算机设备和存储介质
CN112902961A (zh) * 2021-01-19 2021-06-04 宁德思客琦智能装备有限公司 基于机器视觉定位的标定方法、介质、标定设备及***
CN113091752A (zh) * 2021-04-16 2021-07-09 中山大学 一种基于多无人机的目标位姿实时测量方法及***
CN113532375A (zh) * 2021-07-02 2021-10-22 武汉市市政建设集团有限公司 基于无人机测量和编码标志点识别的桥墩关键点测量方法
CN113655806A (zh) * 2021-07-01 2021-11-16 中国人民解放军战略支援部队信息工程大学 一种无人机群辅助降落方法
CN113706621A (zh) * 2021-10-29 2021-11-26 上海景吾智能科技有限公司 基于带标记图像的标志点定位及姿态获取方法和***
CN114136314A (zh) * 2021-11-30 2022-03-04 北京天兵科技有限公司 一种航天飞行器辅助姿态解算方法
CN114170296A (zh) * 2021-11-10 2022-03-11 埃洛克航空科技(北京)有限公司 基于多模式综合决策的旋转平均估计方法以及装置
CN115014278A (zh) * 2022-08-05 2022-09-06 湖南科天健光电技术有限公司 校准方法及装置、测量待测目标的方法、***、飞行器
CN115164823A (zh) * 2022-05-16 2022-10-11 上海芯翌智能科技有限公司 一种摄像机陀螺仪信息的获取方法及设备
CN115218928A (zh) * 2022-08-11 2022-10-21 湖南科天健光电技术有限公司 校准方法、测量待测目标的方法、装置、***及飞行***
CN116007439A (zh) * 2022-12-30 2023-04-25 北京天兵科技有限公司 一种液体火箭射前自动瞄准的方法、装置、介质和设备

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9442485B1 (en) * 2014-08-13 2016-09-13 Trace Live Network Inc. Pixel based image tracking system for unmanned aerial vehicle (UAV) action camera system
CN106767502A (zh) * 2016-12-06 2017-05-31 合肥工业大学 一种具有起始信息的圆形编码标志点
CN106803271A (zh) * 2016-12-23 2017-06-06 成都通甲优博科技有限责任公司 一种视觉导航无人机的摄像机标定方法及装置
CN106803270A (zh) * 2017-01-13 2017-06-06 西北工业大学深圳研究院 无人机平台基于单目slam的多关键帧协同地面目标定位方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9442485B1 (en) * 2014-08-13 2016-09-13 Trace Live Network Inc. Pixel based image tracking system for unmanned aerial vehicle (UAV) action camera system
CN106767502A (zh) * 2016-12-06 2017-05-31 合肥工业大学 一种具有起始信息的圆形编码标志点
CN106803271A (zh) * 2016-12-23 2017-06-06 成都通甲优博科技有限责任公司 一种视觉导航无人机的摄像机标定方法及装置
CN106803270A (zh) * 2017-01-13 2017-06-06 西北工业大学深圳研究院 无人机平台基于单目slam的多关键帧协同地面目标定位方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
郭煜: "基于单目视觉的飞行器姿态角测量技术", 《中国知网》 *

Cited By (39)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107966155A (zh) * 2017-12-25 2018-04-27 北京地平线信息技术有限公司 对象定位方法、对象定位***和电子设备
WO2019165612A1 (zh) * 2018-02-28 2019-09-06 深圳市大疆创新科技有限公司 可移动平台的定位方法及相关装置、***
CN110621962A (zh) * 2018-02-28 2019-12-27 深圳市大疆创新科技有限公司 可移动平台的定位方法及相关装置、***
CN110603503A (zh) * 2018-02-28 2019-12-20 深圳市大疆创新科技有限公司 移动设备的控制方法、设备和存储装置
CN108733066B (zh) * 2018-05-07 2021-05-07 中国人民解放军国防科技大学 一种基于吊舱姿态反馈的目标跟踪控制方法
CN108645408B (zh) * 2018-05-07 2020-07-17 中国人民解放军国防科技大学 一种基于导航信息的无人机自主回收目标预测方法
CN108645408A (zh) * 2018-05-07 2018-10-12 中国人民解放军国防科技大学 一种基于导航信息的无人机自主回收目标预测方法
CN108733066A (zh) * 2018-05-07 2018-11-02 中国人民解放军国防科技大学 一种基于吊舱姿态反馈的目标跟踪控制方法
CN108765494A (zh) * 2018-05-21 2018-11-06 南昌航空大学 一种基于圆柱体标定物的多相机标定方法
CN108765494B (zh) * 2018-05-21 2021-12-24 南昌航空大学 一种基于圆柱体标定物的多相机标定方法
CN109141396A (zh) * 2018-07-16 2019-01-04 南京航空航天大学 辅助信息与随机抽样一致算法融合的无人机位姿估计方法
CN109141396B (zh) * 2018-07-16 2022-04-26 南京航空航天大学 辅助信息与随机抽样一致算法融合的无人机位姿估计方法
CN111192318B (zh) * 2018-11-15 2023-09-01 杭州海康威视数字技术股份有限公司 确定无人机位置和飞行方向的方法、装置及无人机
CN111192318A (zh) * 2018-11-15 2020-05-22 杭州海康机器人技术有限公司 确定无人机位置和飞行方向的方法、装置及无人机
CN109677217A (zh) * 2018-12-27 2019-04-26 魔视智能科技(上海)有限公司 牵引车与挂车偏航角的检测方法
CN111247389A (zh) * 2019-03-29 2020-06-05 深圳市大疆创新科技有限公司 关于拍摄设备的数据处理方法、装置及图像处理设备
CN110487249A (zh) * 2019-07-17 2019-11-22 广东工业大学 一种用于结构三维振动测量的无人机标定方法
CN111536984A (zh) * 2020-05-11 2020-08-14 北京百度网讯科技有限公司 定位方法和装置、车端设备、车辆、电子设备和定位***
US11405744B2 (en) 2020-05-11 2022-08-02 Apollo Intelligent Connectivity (Beijing) Technology Co., Ltd. Positioning method and device, on-board equipment, vehicle, and positioning system
CN112265463B (zh) * 2020-10-16 2022-07-26 北京猎户星空科技有限公司 自移动设备的控制方法、装置、自移动设备和介质
CN112265463A (zh) * 2020-10-16 2021-01-26 北京猎户星空科技有限公司 自移动设备的控制方法、装置、自移动设备和介质
CN112419403A (zh) * 2020-11-30 2021-02-26 海南大学 一种基于二维码阵列的室内无人机定位方法
CN112507885A (zh) * 2020-12-10 2021-03-16 国网江西省电力有限公司南昌供电分公司 一种巡线无人机识别侵扰的方法
CN112507885B (zh) * 2020-12-10 2023-07-21 国网江西省电力有限公司南昌供电分公司 一种巡线无人机识别侵扰的方法
CN112902961A (zh) * 2021-01-19 2021-06-04 宁德思客琦智能装备有限公司 基于机器视觉定位的标定方法、介质、标定设备及***
CN112711263A (zh) * 2021-01-19 2021-04-27 未来机器人(深圳)有限公司 仓储自动导引车避障方法、装置、计算机设备和存储介质
CN113091752A (zh) * 2021-04-16 2021-07-09 中山大学 一种基于多无人机的目标位姿实时测量方法及***
CN113655806A (zh) * 2021-07-01 2021-11-16 中国人民解放军战略支援部队信息工程大学 一种无人机群辅助降落方法
CN113655806B (zh) * 2021-07-01 2023-08-08 中国人民解放军战略支援部队信息工程大学 一种无人机群辅助降落方法
CN113532375B (zh) * 2021-07-02 2022-05-20 武汉市市政建设集团有限公司 基于无人机测量和编码标志点识别的桥墩关键点测量方法
CN113532375A (zh) * 2021-07-02 2021-10-22 武汉市市政建设集团有限公司 基于无人机测量和编码标志点识别的桥墩关键点测量方法
CN113706621A (zh) * 2021-10-29 2021-11-26 上海景吾智能科技有限公司 基于带标记图像的标志点定位及姿态获取方法和***
CN114170296A (zh) * 2021-11-10 2022-03-11 埃洛克航空科技(北京)有限公司 基于多模式综合决策的旋转平均估计方法以及装置
CN114136314A (zh) * 2021-11-30 2022-03-04 北京天兵科技有限公司 一种航天飞行器辅助姿态解算方法
CN115164823A (zh) * 2022-05-16 2022-10-11 上海芯翌智能科技有限公司 一种摄像机陀螺仪信息的获取方法及设备
CN115164823B (zh) * 2022-05-16 2024-04-02 上海芯翌智能科技有限公司 一种摄像机陀螺仪信息的获取方法及设备
CN115014278A (zh) * 2022-08-05 2022-09-06 湖南科天健光电技术有限公司 校准方法及装置、测量待测目标的方法、***、飞行器
CN115218928A (zh) * 2022-08-11 2022-10-21 湖南科天健光电技术有限公司 校准方法、测量待测目标的方法、装置、***及飞行***
CN116007439A (zh) * 2022-12-30 2023-04-25 北京天兵科技有限公司 一种液体火箭射前自动瞄准的方法、装置、介质和设备

Also Published As

Publication number Publication date
CN107314771B (zh) 2020-04-21

Similar Documents

Publication Publication Date Title
CN107314771A (zh) 基于编码标志点的无人机定位以及姿态角测量方法
US11120560B2 (en) System and method for real-time location tracking of a drone
CN102967305B (zh) 基于大小回字标志物的多旋翼无人机位姿获取方法
CN105981074B (zh) 用于标定成像装置的***、方法和装置
CN103759670B (zh) 一种基于数字近景摄影的物体三维信息获取方法
US20200191556A1 (en) Distance mesurement method by an unmanned aerial vehicle (uav) and uav
CN108955685B (zh) 一种基于立体视觉的加油飞机锥套位姿测量方法
Yang et al. Panoramic UAV surveillance and recycling system based on structure-free camera array
CN111192318B (zh) 确定无人机位置和飞行方向的方法、装置及无人机
CN107300377B (zh) 一种绕飞轨迹下的旋翼无人机三维目标定位方法
CN105091744A (zh) 一种基于视觉传感器和激光测距仪的位姿检测装置与方法
CN105067011A (zh) 一种基于视觉标定及坐标转换的测量***整体校准方法
CN110517325A (zh) 一种坐标变换及坐标变换的车身周围物体定位方法和***
CN109087355B (zh) 基于迭代更新的单目相机位姿测量装置与方法
CN103256896A (zh) 一种高速滚转***姿测量方法
CN108764080B (zh) 一种基于点云空间二值化的无人机视觉避障方法
CN105043392B (zh) 一种飞行器位姿确定方法及装置
CN110044374A (zh) 一种基于图像特征的单目视觉测量里程的方法及里程计
Xia et al. Global calibration of multi-cameras with non-overlapping fields of view based on photogrammetry and reconfigurable target
CN106683038A (zh) 一种生成火情态势图的方法及装置
CN104482924A (zh) 旋成体目标位姿视觉测量方法
Luo et al. Docking navigation method for UAV autonomous aerial refueling
CN115267747A (zh) 一种稀疏激光雷达与可见光/红外成像***的标定方法
CN113340272B (zh) 一种基于无人机微群的地面目标实时定位方法
CN105403886B (zh) 一种机载sar定标器图像位置自动提取方法

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
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20200421