CN111309050B - 一种无人机目标识别定位方法 - Google Patents
一种无人机目标识别定位方法 Download PDFInfo
- Publication number
- CN111309050B CN111309050B CN202010144063.XA CN202010144063A CN111309050B CN 111309050 B CN111309050 B CN 111309050B CN 202010144063 A CN202010144063 A CN 202010144063A CN 111309050 B CN111309050 B CN 111309050B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- plane
- coordinate system
- obstacle
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Abstract
本发明公开了一种无人机目标识别定位方法,在无人机进行飞行的时候遇到障碍物的时候,无人机在通过在遇到障碍物的时候,在原地进行螺旋形运动,直至障碍物对飞行的轨迹不受影响,之后在重新规划飞行的线路,使得无人机可以正常的进行飞行;通过飞行器周向的测距装置,得到飞行器飞行平面的障碍物的空间模型,飞行器做螺旋形运动的平面与飞行器飞行平面垂直,这样就可以使得飞行器在纵向的平面上寻找新的突破口;在通过障碍物的时候,同时实时的进行飞行器飞行平面的障碍物的空间模型的建立并且检测障碍物,在确认没有障碍物之后,根据当前的位置,行使会原始的飞行路径。
Description
技术领域
本发明涉及自主导航避障技术领域,特别涉及一种无人机目标识别定位方法。
背景技术
无人驾驶飞机简称无人机,是利用无线电遥控设备和自备的程序控制装置操纵的不载人飞机。目前的一般的无人机有两种形式,分别是固定翼的无人机和多旋翼的无人机。
无论是哪一种无人机,在飞行的时候,都会按照设定的飞行路径进行飞行,在飞行的过程中,往往会遇到一些障碍物,而无人机就需要绕过这些障碍物之后,继续返回原有的轨迹进行飞行。目前,对于无人机避障的方法有很多,通常都是使用点云的技术手段,构建三维的障碍物模型,然后在使得无人机改变飞行姿势,从而越过障碍物。这样的方式虽然可以有效的使得无人机避过障碍物,但是需要大量的进行数据的运算,使得无人机在飞行的过程中会耗费大量的能量。
发明内容
本发明的目的是克服上述现有技术中存在的问题,提供一种无人机目标识别定位方法,通过在遇到障碍物的时候,在原地进行螺旋形运动,直至障碍物对飞行的轨迹不受影响,之后在重新规划飞行的线路,使得无人机可以正常的进行飞行。
为此,本发明提供一种无人机目标识别定位方法,包括如下步骤:
S1:通过架设在无人机表面周向的若干个测距装置所测得的距离,以无人机为坐标原点建立平面坐标系,根据无人机表面周向的若干个测距装置所测得的距离在所建立的平面坐标系中绘制障碍物面向无人机的边缘;
S2:将无人机的飞行轨道嵌入到上述的平面坐标系中,并检测无人机的飞行轨道与步骤S1中的障碍物面向无人机的边缘之间是否有重合部分,如果没有重合部分,执行上述步骤S1,如果有重合部分,执行上述步骤S3;
S3:无人机在与所述平面坐标系的平面所垂直的平面上进行螺旋形运动,同时保持步骤S2中所述无人机的飞行轨道在平面坐标系中的位置,执行步骤S1并更新平面坐标系中障碍物面向无人机的边缘;
S4:检测无人机的飞行轨道与步骤S3中的障碍物面向无人机的边缘之间是否有重合部分,如果有重合部分,则重复执行步骤S3,如没有重合部分,则使得无人机沿着该平面坐标系中的飞行轨道飞行到所述测距装置的最大量程的时候,返回步骤S2中的飞行轨道上。
进一步,在步骤S3中,无人机在与所述平面坐标系的平面所垂直的平面上进行螺旋形运动的时候,首先以无人机为原点,将所述平面坐标系拓展为三维坐标系,然后将所述平面坐标系中的障碍物面向无人机的边缘导入到三维坐标系中,在三维坐标系中确立一垂直与所述平面坐标系的平面且同时平行与所述障碍物面向无人机的边缘的切线的竖直平面,该竖直平面过所述三维坐标系的原点,最后在该竖直平面建立螺旋形的飞行轨迹,并且使得飞行器按照该螺旋形的飞行轨迹的飞行轨迹进行飞行。
更进一步,在竖直平面建立螺旋形的飞行轨迹的时候,根据所述无人机的尺寸进行螺旋半径的设定,在根据设定的螺旋半径建立螺旋形的飞行轨迹。
进一步,所述无人机表面周向的若干个测距装置分别均匀的密布在所述无人机表面周向。
更进一步,所述无人机表面周向包括水平面方向上的周向和竖直面方向上的周向。
进一步,在步骤S4中,所述返回步骤S2中的飞行轨道上,根据所述无人机自身的定位装置得到无人机的三维位置,同时获取所述步骤S2中的飞行轨道在的三维位置,根据无人机的三维位置和所述步骤S2中的飞行轨道在的三维位置控制无人机返回步骤S2中的飞行轨道上。
进一步,在步骤S1中,所述根据无人机表面周向的若干个测距装置所测得的距离在所建立的平面坐标系中绘制障碍物面向无人机的边缘,首先以无人机为所述平面坐标系的原点,若干个测距装置所测得的距离根据其在无人机上的方位和其所测得的距离在平面坐标系的原点上绘制向量,最后将向量的末端进行连接得到障碍物面向无人机的边缘。
更进一步,当测距装置所测得的距离超过其量程范围的时候,向量的值选取最大量程的数值,在连接向量的末端的时候,只连接向量值在量程范围内的向量的末端。
本发明提供的一种无人机目标识别定位方法,具有如下有益效果:
1、通过在遇到障碍物的时候,在原地进行螺旋形运动,直至障碍物对飞行的轨迹不受影响,之后在重新规划飞行的线路,使得无人机可以正常的进行飞行;
2、通过飞行器周向的测距装置,得到飞行器飞行平面的障碍物的空间模型,飞行器做螺旋形运动的平面与飞行器飞行平面垂直,这样就可以使得飞行器在纵向的平面上寻找新的突破口;
3、在通过障碍物的时候,同时实时的进行飞行器飞行平面的障碍物的空间模型的建立并且检测障碍物,在确认没有障碍物之后,根据当前的位置,行使会原始的飞行路径。
附图说明
图1为本发明提供的一种无人机目标识别定位方法的整体流程示意图。
具体实施方式
下面结合附图,对本发明的一个具体实施方式进行详细描述,但应当理解本发明的保护范围并不受具体实施方式的限制。
在本申请文件中,未经明确的部件型号以及结构,均为本领域技术人员所公知的现有技术,本领域技术人员均可根据实际情况的需要进行设定,在本申请文件的实施例中不做具体的限定。
具体的,如图1所示,本发明实施例提供了一种无人机目标识别定位方法,包括如下步骤:
S1:通过架设在无人机表面周向的若干个测距装置所测得的距离,以无人机为坐标原点建立平面坐标系,根据无人机表面周向的若干个测距装置所测得的距离在所建立的平面坐标系中绘制障碍物面向无人机的边缘;
该步骤通过测距装置得到无人机所在的平面的二维平面的障碍物模型,即障碍物面向无人机的边缘,该模型是实时的进行变动的。在本实施例中,测距装置可以为红外测距仪。
S2:将无人机的飞行轨道嵌入到上述的平面坐标系中,并检测无人机的飞行轨道与步骤S1中的障碍物面向无人机的边缘之间是否有重合部分,如果没有重合部分,执行上述步骤S1,如果有重合部分,执行上述步骤S3;
该步骤将无人机的飞行轨道嵌入到步骤S1中得到的二维平面的障碍物模型,通过检测重合的部分,就可以知道无人机在飞行轨道上飞行的时候回遇到的障碍物,如果没有重合部分,则没有障碍物,则继续重新执行上述步骤S1的内容,如果有重合部分,则存在障碍物,则执行步骤S3的内容.
S3:无人机在与所述平面坐标系的平面所垂直的平面上进行螺旋形运动,同时保持步骤S2中所述无人机的飞行轨道在平面坐标系中的位置,执行步骤S1并更新平面坐标系中障碍物面向无人机的边缘;
该步骤使得无人机在平面坐标系的平面所垂直的平面上进行螺旋形运动,这样就可以得到无人机的飞行轨道上纵向方向上的障碍物的情况。
S4:检测无人机的飞行轨道与步骤S3中的障碍物面向无人机的边缘之间是否有重合部分,如果有重合部分,则重复执行步骤S3,如没有重合部分,则使得无人机沿着该平面坐标系中的飞行轨道飞行到所述测距装置的最大量程的时候,返回步骤S2中的飞行轨道上。
该步骤使得无人机在检测到可以穿过障碍物之后,重新回到原有的飞行轨道上,在进行正常的飞行。
在本实施例中,在上述步骤S3中,无人机在与所述平面坐标系的平面所垂直的平面上进行螺旋形运动的时候,首先以无人机为原点,将所述平面坐标系拓展为三维坐标系,然后将所述平面坐标系中的障碍物面向无人机的边缘导入到三维坐标系中,在三维坐标系中确立一垂直与所述平面坐标系的平面且同时平行与所述障碍物面向无人机的边缘的切线的竖直平面,该竖直平面过所述三维坐标系的原点,最后在该竖直平面建立螺旋形的飞行轨迹,并且使得飞行器按照该螺旋形的飞行轨迹的飞行轨迹进行飞行。
进一步的,在竖直平面建立螺旋形的飞行轨迹的时候,根据所述无人机的尺寸进行螺旋半径的设定,在根据设定的螺旋半径建立螺旋形的飞行轨迹。
在本实施例中,所述无人机表面周向的若干个测距装置分别均匀的密布在所述无人机表面周向。所述无人机表面周向包括水平面方向上的周向和竖直面方向上的周向。
在本实施例中,在上述步骤S4中,所述返回上述步骤S2中的飞行轨道上,根据所述无人机自身的定位装置得到无人机的三维位置,同时获取所述上述步骤S2中的飞行轨道在的三维位置,根据无人机的三维位置和所述上述步骤S2中的飞行轨道在的三维位置控制无人机返回上述步骤S2中的飞行轨道上。
在本实施例中,在上述步骤S1中,所述根据无人机表面周向的若干个测距装置所测得的距离在所建立的平面坐标系中绘制障碍物面向无人机的边缘,首先以无人机为所述平面坐标系的原点,若干个测距装置所测得的距离根据其在无人机上的方位和其所测得的距离在平面坐标系的原点上绘制向量,最后将向量的末端进行连接得到障碍物面向无人机的边缘。
进一步的,当测距装置所测得的距离超过其量程范围的时候,向量的值选取最大量程的数值,在连接向量的末端的时候,只连接向量值在量程范围内的向量的末端。
综上所述,本发明公开了一种无人机目标识别定位方法,在无人机进行飞行的时候遇到障碍物的时候,无人机在通过在遇到障碍物的时候,在原地进行螺旋形运动,直至障碍物对飞行的轨迹不受影响,之后在重新规划飞行的线路,使得无人机可以正常的进行飞行;通过飞行器周向的测距装置,得到飞行器飞行平面的障碍物的空间模型,飞行器做螺旋形运动的平面与飞行器飞行平面垂直,这样就可以使得飞行器在纵向的平面上寻找新的突破口;在通过障碍物的时候,同时实时的进行飞行器飞行平面的障碍物的空间模型的建立并且检测障碍物,在确认没有障碍物之后,根据当前的位置,行使会原始的飞行路径。
以上公开的仅为本发明的几个具体实施例,但是,本发明实施例并非局限于此,任何本领域的技术人员能思之的变化都应落入本发明的保护范围。
Claims (6)
1.一种无人机目标识别定位方法,其特征在于,包括如下步骤:
S1:通过架设在无人机表面周向的若干个测距装置所测得的距离,以无人机为坐标原点建立平面坐标系,根据无人机表面周向的若干个测距装置所测得的距离在所建立的平面坐标系中绘制障碍物面向无人机的边缘,所述根据无人机表面周向的若干个测距装置所测得的距离在所建立的平面坐标系中绘制障碍物面向无人机的边缘,首先以无人机为所述平面坐标系的原点,若干个测距装置所测得的距离根据其在无人机上的方位和其所测得的距离在平面坐标系的原点上绘制向量,最后将向量的末端进行连接得到障碍物面向无人机的边缘;
S2:将无人机的飞行轨道嵌入到上述的平面坐标系中,并检测无人机的飞行轨道与步骤S1中的障碍物面向无人机的边缘之间是否有重合部分,如果没有重合部分,执行上述步骤S1,如果有重合部分,执行步骤S3;
S3:无人机在与所述平面坐标系的平面所垂直的平面上进行螺旋形运动,同时保持步骤S2中所述无人机的飞行轨道在平面坐标系中的位置,执行步骤S1并更新平面坐标系中障碍物面向无人机的边缘,无人机在与所述平面坐标系的平面所垂直的平面上进行螺旋形运动的时候,首先以无人机为原点,将所述平面坐标系拓展为三维坐标系,然后将所述平面坐标系中的障碍物面向无人机的边缘导入到三维坐标系中,在三维坐标系中确立一垂直与所述平面坐标系的平面且同时平行与所述障碍物面向无人机的边缘的切线的竖直平面,该竖直平面过所述三维坐标系的原点,最后在该竖直平面建立螺旋形的飞行轨迹,并且使得飞行器按照该螺旋形的飞行轨迹的飞行轨迹进行飞行;
S4:检测无人机的飞行轨道与步骤S3中的障碍物面向无人机的边缘之间是否有重合部分,如果有重合部分,则重复执行步骤S3,如没有重合部分,则使得无人机沿着该平面坐标系中的飞行轨道飞行到所述测距装置的最大量程的时候,返回步骤S2中的飞行轨道上。
2.如权利要求1所述的一种无人机目标识别定位方法,其特征在于,在竖直平面建立螺旋形的飞行轨迹的时候,根据所述无人机的尺寸进行螺旋半径的设定,在根据设定的螺旋半径建立螺旋形的飞行轨迹。
3.如权利要求1所述的一种无人机目标识别定位方法,其特征在于,所述无人机表面周向的若干个测距装置分别均匀的密布在所述无人机表面周向。
4.如权利要求3所述的一种无人机目标识别定位方法,其特征在于,所述无人机表面周向包括水平面方向上的周向和竖直面方向上的周向。
5.如权利要求1所述的一种无人机目标识别定位方法,其特征在于,在步骤S4中,所述返回步骤S2中的飞行轨道上,根据所述无人机自身的定位装置得到无人机的三维位置,同时获取所述步骤S2中的飞行轨道在的三维位置,根据无人机的三维位置和所述步骤S2中的飞行轨道在的三维位置控制无人机返回步骤S2中的飞行轨道上。
6.如权利要求1所述的一种无人机目标识别定位方法,其特征在于,当测距装置所测得的距离超过其量程范围的时候,向量的值选取最大量程的数值,在连接向量的末端的时候,只连接向量值在量程范围内的向量的末端。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010144063.XA CN111309050B (zh) | 2020-03-04 | 2020-03-04 | 一种无人机目标识别定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010144063.XA CN111309050B (zh) | 2020-03-04 | 2020-03-04 | 一种无人机目标识别定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111309050A CN111309050A (zh) | 2020-06-19 |
CN111309050B true CN111309050B (zh) | 2023-07-04 |
Family
ID=71162041
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010144063.XA Active CN111309050B (zh) | 2020-03-04 | 2020-03-04 | 一种无人机目标识别定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111309050B (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102160006A (zh) * | 2008-07-15 | 2011-08-17 | 空中侦察辨识和避免技术有限责任公司 | 用于避免碰撞的系统和方法 |
CN103778523A (zh) * | 2014-01-09 | 2014-05-07 | 武汉猎隼科技有限公司 | 一种垂直起降无人机及其精确定位及避障方法 |
CN104820429A (zh) * | 2015-04-28 | 2015-08-05 | 南京航空航天大学 | 基于超声波距离检测的无人机避障系统及其控制方法 |
CN104914877A (zh) * | 2015-07-13 | 2015-09-16 | 沈阳飞羽航空科技有限公司 | 一种轻型无人机自主感知与规避方法 |
CN105955304A (zh) * | 2016-07-06 | 2016-09-21 | 零度智控(北京)智能科技有限公司 | 一种避障方法、避障装置及无人飞行器 |
CN106094847A (zh) * | 2016-06-07 | 2016-11-09 | 廖兴池 | 一种无人机自动避障控制技术及其装置 |
CN107077148A (zh) * | 2016-11-22 | 2017-08-18 | 深圳市大疆创新科技有限公司 | 无人机避障控制方法、飞行控制器及无人飞行器 |
CN110658840A (zh) * | 2019-10-28 | 2020-01-07 | 郑州航空工业管理学院 | 一种用于多旋翼无人机的自主导航避障方法及装置 |
CN110799801A (zh) * | 2018-09-28 | 2020-02-14 | 深圳市大疆创新科技有限公司 | 基于无人机的测距方法、装置及无人机 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2869106B1 (fr) * | 2004-04-20 | 2006-06-23 | Thales Sa | Procede d'estimation de distance pour aeronef avec prise en compte de contraintes de navigation aerienne |
FR3008530B1 (fr) * | 2013-07-10 | 2015-07-17 | Eurocopter France | Procede et dispositif d'emission d'alertes pour l'evitement de terrain par un aeronef a voilure tournante |
-
2020
- 2020-03-04 CN CN202010144063.XA patent/CN111309050B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102160006A (zh) * | 2008-07-15 | 2011-08-17 | 空中侦察辨识和避免技术有限责任公司 | 用于避免碰撞的系统和方法 |
CN103778523A (zh) * | 2014-01-09 | 2014-05-07 | 武汉猎隼科技有限公司 | 一种垂直起降无人机及其精确定位及避障方法 |
CN104820429A (zh) * | 2015-04-28 | 2015-08-05 | 南京航空航天大学 | 基于超声波距离检测的无人机避障系统及其控制方法 |
CN104914877A (zh) * | 2015-07-13 | 2015-09-16 | 沈阳飞羽航空科技有限公司 | 一种轻型无人机自主感知与规避方法 |
CN106094847A (zh) * | 2016-06-07 | 2016-11-09 | 廖兴池 | 一种无人机自动避障控制技术及其装置 |
CN105955304A (zh) * | 2016-07-06 | 2016-09-21 | 零度智控(北京)智能科技有限公司 | 一种避障方法、避障装置及无人飞行器 |
CN107077148A (zh) * | 2016-11-22 | 2017-08-18 | 深圳市大疆创新科技有限公司 | 无人机避障控制方法、飞行控制器及无人飞行器 |
CN110799801A (zh) * | 2018-09-28 | 2020-02-14 | 深圳市大疆创新科技有限公司 | 基于无人机的测距方法、装置及无人机 |
CN110658840A (zh) * | 2019-10-28 | 2020-01-07 | 郑州航空工业管理学院 | 一种用于多旋翼无人机的自主导航避障方法及装置 |
Non-Patent Citations (1)
Title |
---|
李 玮,裴忠贵.多旋翼无人机的超声波避障系统.《 用电与能效专题讲座暨智能用电及能效管理技术研讨会》.2019, * |
Also Published As
Publication number | Publication date |
---|---|
CN111309050A (zh) | 2020-06-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Barry et al. | High‐speed autonomous obstacle avoidance with pushbroom stereo | |
US11149717B2 (en) | Unmanned aerial vehicle wind turbine inspection systems and methods | |
CN110426046B (zh) | 一种无人机自主着陆跑道区域障碍物判断与跟踪方法 | |
Kim et al. | Airborne simultaneous localisation and map building | |
CN104881039A (zh) | 一种无人机返航的方法及系统 | |
EP3276440A1 (en) | Sense and avoid maneuvering | |
EP2715471B1 (en) | Method and system for steering an unmanned aerial vehicle | |
CN107223199A (zh) | 基于三维地图的导航方法和设备 | |
CN105841703A (zh) | 一种威胁环境下目标定位的无人机最优航路计算方法 | |
CN106991700A (zh) | 一种无人机目标位置锁定和追踪装置及其方法 | |
WO2020087297A1 (zh) | 一种无人机测试方法、设备及存储介质 | |
CN112789672A (zh) | 控制和导航系统、姿态优化、映射和定位技术 | |
KR102386831B1 (ko) | 군집 비행 시 포메이션 이탈 무인 비행체의 처리 시스템 및 방법 | |
Yu et al. | Observability-based local path planning and obstacle avoidance using bearing-only measurements | |
Schofield et al. | Cloud to cable: A drone framework for autonomous power line inspection | |
Yu et al. | A vision-based collision avoidance technique for micro air vehicles using local-level frame mapping and path planning | |
CN105066998A (zh) | 一种基于量子鸽群优化的无人机自主空中加油目标检测方法 | |
CN111309050B (zh) | 一种无人机目标识别定位方法 | |
Kim et al. | A deep-learning-aided automatic vision-based control approach for autonomous drone racing in game of drones competition | |
KR102289752B1 (ko) | Gps 음영 지역에서 경로 비행을 수행하는 드론 및 그 방법 | |
Li et al. | UAV obstacle avoidance by human-in-the-loop reinforcement in arbitrary 3D environment | |
Bhandari et al. | Uav collision detection and avoidance using ads-b sensor and custom ads-b like solution | |
KR102263294B1 (ko) | 무인비행체 비행 제어 시스템 및 방법 | |
Zhu et al. | Positioning accuracy and formation analysis of multi-UAV passive positioning system | |
Mahamud et al. | ALW drone: A new design and efficient approach |
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 |