CN104597910B - 一种基于瞬时碰撞点的无人机非协作式实时避障方法 - Google Patents
一种基于瞬时碰撞点的无人机非协作式实时避障方法 Download PDFInfo
- Publication number
- CN104597910B CN104597910B CN201410706448.5A CN201410706448A CN104597910B CN 104597910 B CN104597910 B CN 104597910B CN 201410706448 A CN201410706448 A CN 201410706448A CN 104597910 B CN104597910 B CN 104597910B
- Authority
- CN
- China
- Prior art keywords
- obstacle
- mrow
- node
- collision
- msub
- 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
- 238000000034 method Methods 0.000 title claims abstract description 34
- 230000033001 locomotion Effects 0.000 claims abstract description 32
- 238000001514 detection method Methods 0.000 claims abstract description 30
- 230000004888 barrier function Effects 0.000 claims description 8
- 230000008859 change Effects 0.000 claims description 5
- 230000000007 visual effect Effects 0.000 claims description 4
- 230000005622 photoelectricity Effects 0.000 claims 2
- 230000015572 biosynthetic process Effects 0.000 claims 1
- 238000010276 construction Methods 0.000 claims 1
- 238000001914 filtration Methods 0.000 claims 1
- 238000005192 partition Methods 0.000 claims 1
- 230000000750 progressive effect Effects 0.000 claims 1
- 230000008901 benefit Effects 0.000 abstract description 3
- 238000011156 evaluation Methods 0.000 abstract description 3
- 230000003068 static effect Effects 0.000 description 12
- 238000010586 diagram Methods 0.000 description 9
- 230000006872 improvement Effects 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 6
- 238000013459 approach Methods 0.000 description 5
- 230000008447 perception Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000003709 image segmentation Methods 0.000 description 2
- 239000013598 vector Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000877 morphologic effect Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000010187 selection method Methods 0.000 description 1
- 238000013179 statistical model Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于瞬时碰撞点的无人机非协作式实时避障方法，其步骤为：(1)障碍探测：获取障碍的相对运动状态；(2)障碍运动估计：基于卫星导航信息获取本机状态信息，计算出惯性空间障碍的运动状态；(3)碰撞冲突检测：判断是否会与障碍发生碰撞；(4)避障决策：基于步骤(3)的检测结果，做出避障决策；(5)基于考虑瞬时碰撞点的快速扩展随机树算法的避障航线重规划：基于瞬时碰撞点，引入航线评价启发信息，实现避障航线重规划。本发明具有原理简单、易实现、能够提高无人机安全性等优点。
Description
技术领域
本发明主要涉及到无人机领域，特指一种基于瞬时碰撞点的无人机非协作式实时避障方法。
背景技术
随着无人机系统能力的不断发展，众多功能各异的无人机被广泛应用于各种民事行动中，这也导致无人机在使用空域数量的迅速增加。目前，无人机系统的自主能力普遍不高，其操作使用主要是由地面站遥控或预编程的，没有空间障碍的感知和规避(Sense andAvoid,SAA)能力，从而导致空中碰撞事故频频发生。
目前，无人机系统实现感知与规避主要有两种途径：
第一种途径：通过地基感知与规避，在地面站基于无人机的状态测控数据，实现同一空域内执行不同任务的无人机之间时空冲突消解。
第二种途径：随着传感器技术和自动化技术的进步，实现机载的感知与规避。这也分为两大类，一类是安装了ADS-B(广播式自动相关监视)和TCAS(交通预警和避撞系统)的无人机之间的协作式避碰；另一类是未安装ADS-B或者TCAS的无人机或者该装置失灵条件下无人机之间，以及无人机与空中其他障碍(高山、高建筑等)之间的非协作式避碰。非协作式避碰作为无人机依托机载传感器设备及时检测障碍并实施有效规避的重要保障，对于提高无人机飞行安全具有更为重要的意义，其技术已成为当前研究的热点。
非协作式避碰主要有三种方式：主动系统、被动系统和混合系统。主动系统能发射信号来检测障碍物，包括机载微波雷达、毫米波雷达、激光、声纳、主动电子扫描阵列(AESA)雷达等主动传感器。被动系统则用于检测从障碍物散发的信号，主要包括光电(EO)、红外(IR)等被动传感器。混合系统采用主动传感器和被动传感器混合的探测模式。非协作式避碰无需其它无人机拥有相同的系统，可用于检测包括飞机在内的地面、空中的障碍物。
发明内容
本发明要解决的技术问题就在于：针对现有技术存在的技术问题，本发明提供一种原理简单、易实现、能够提高无人机安全性的基于瞬时碰撞点的无人机非协作式实时避障方法。
为解决上述技术问题，本发明采用以下技术方案：
一种基于瞬时碰撞点的无人机非协作式实时避障方法，其步骤为：
(1)障碍探测：获取障碍的相对运动状态；
(2)障碍运动估计：基于卫星导航信息获取本机状态信息，计算出惯性空间障碍的运动状态
(3)碰撞冲突检测：判断是否会与障碍发生碰撞；
(4)避障决策：基于步骤(3)的检测结果，做出避障决策；
(5)基于考虑瞬时碰撞点的快速扩展随机树算法的避障航线重规划：基于瞬时碰撞点，引入航线评价启发信息，实现避障航线重规划。
作为本发明的进一步改进：所述步骤(5)的具体步骤为：
(5.1)：以当前无人机的位置作为初始节点Nodeinit，初始化搜索树结构，只包含一个节点；根据预测碰撞算法，得到预测碰撞时间Tcollision，以瞬时碰撞点为圆心，以无人机安全距离RSafe为半径，形成预测碰撞区域Regioncollision，将当前本机位置、预测碰撞点和障碍位置形成的三角形区域，称为航线规避区Regionavoid；
(5.2)基于基本RRT流程，按照以下步骤扩展搜索树：
(5.2.1)产生随机数P∈[0,1]，如果P<PG则选择Nodegoal作为目标点Nodetarget，否则在未搜索区域范围内产生一个位于障碍区域外产生随机点Noderand；若随机点Noderand未落入预测碰撞区和航线规避区，则选取Noderand作为目标点Nodetarget，否则继续生成随机点Noderand；分别落入了航线规避区Regionavoid和预测碰撞区域Regioncollision，则将这两个随机点排除，选择作为目标点Nodetarget；
(5.2.2)在当前生成树T中，查询与Nodetarget最近的节点，记为Nodenear，根据飞机行进步长，计算得到行进节点Nodetemp，并判断与Nodenear的运动时间t是否落入预测碰撞时间Tcollision内；如果t在Tcollision内，则继续判断Nodetemp是否落入航线规避区Regionavoid和预测碰撞区域Regioncollision，如果没有，则转入(5.2.3)，否则舍弃随机点Nodetemp并转入(5.2.1)；
(5.2.3)将扩展节点Nodetemp记为Nodenew，并加入搜索树T中，作为Nodenear的子节点；
(5.2.4)如果||Nodenew-Nodegoal||≤ε，则搜索到目标点，跳到步骤(5.3)；否则更新计算航线规避区Regionavoid和预测碰撞区域Regioncollision以及碰撞时间Tcollision，并返回步骤(5.2)；
(5.2.5)如果搜索时间超过搜索时间上限Tmax，则强制结束扩展，跳到步骤(5.3)；
(5.3)返回形成的扩展搜索树，获得Nodeinit从到Nodegoal的航线；如果是强制结束，则返回从Nodeinit到距离Nodegoal最近的叶节点的航线。
作为本发明的进一步改进：所述步骤(3)的具体步骤为：
(3.1)分别求出障碍物速度以及无人机速度与基准线的夹角分别为a，β，将障碍物速度Va和无人机的速度Vb分解到垂直于两者质心的连线，得到Va1和Vb1：
Va1＝Vasinα (1)
Vb1＝Vbsinβ (2)
将约束条件加强，障碍物在无人机的前方需满足如下条件：
Vacosα>0 (3)
Vbcosβ>0 (4)
(3.2)判断：
若Va1＝Vb1，则在当前条件下飞行无人机与障碍物会发生碰撞，并得到瞬时碰撞点的坐标位置；若检测到能够发生碰撞，碰撞的时间约束通过计算得知，得出无人机和障碍物相距距离为S，不进行避障发生碰撞的时间Tcollision为：
即在不考虑其他情况的条件下，无人机完成避障行为的时间t<Tcollision；
无人机和障碍之间存在一个安全距离RSafe，在小于此距离内，碰撞仍将会发生，即则若下式成立，碰撞仍然会发生：
碰撞时间为：
作为本发明的进一步改进：所述步骤(3)中，如果空中存在多个障碍，则计算相互之间的碰撞关系；若有可能发生碰撞，则得到多个瞬时碰撞点。
作为本发明的进一步改进：所述步骤(1)中，无人机的障碍探测采用光电/红外传感器和雷达混合的探测体制；所述光电/红外传感器用来形成视觉图像，然后采用图像分割方法将障碍目标提取出来；所述雷达传感器用来获取障碍的距离和方位，作为障碍相对于本无人机的状态信息。
作为本发明的进一步改进：所述步骤(2)中，对无人机障碍的运动估计是基于导航信息， 通过实时测得自身的运动状态信息，将测量到的目标相对于本无人机的状态信息进行解算，获得障碍相对于惯性空间的运动状态；通过对典型目标运动模型进行分析，基于离散-连续扩展卡尔曼滤波方法实现障碍运动状态估计。
作为本发明的进一步改进：所述步骤(4)包括：
当为协作式障碍时，依据空中交通规则，规定飞机在相对飞行相遇时，各自向右转躲避对方；在同向飞行时，如果要超越前方的飞机，后面的飞机要改变高度或从右侧超越；航向不同的飞机在空中交汇时，左方的飞机要为右面的飞机让路。
当为非协作式障碍时，依靠本机完成避障行为决策；在时间紧急条件下，采取应急机动控制；在有调整时间的前提下，进行航线的实时重规划，完成避障航线的实时调整。
与现有技术相比，本发明的优点在于：本发明的基于瞬时碰撞点的无人机非协作式实时避障方法，原理简单、易实现、能够提高无人机安全性的；其能够基于目前的机载传感器设备，获取空中障碍的运动状态信息，采用交互多模型的无色卡尔曼滤波算法实现障碍运动状态估计，同时基于机载导航设备的导航信息，实现无人机自身的运动状态估计，在此基础上，完成无人机和障碍的碰撞检测，并完成实时航线重规划，指引无人机有效规避障碍。
附图说明
图1是本发明方法的流程示意图。
图2是本发明中平行接近法的原理示意图。
图3是本发明中SA-RRT算法的原理示意图。
图4是本发明中SA-RRT算法的流程示意图。
图5是本发明在具体应用实例中无人机规避静态障碍时的原理示意图；其中图5(a)为一个静态障碍时的示意图；图5(b)为一个静态障碍时的示意图；图5(c)为一个静态障碍时的示意图。
图6是本发明在具体应用实例中无人机规避动态障碍物时的原理示意图；其中图6(a)为一个动态障碍时的示意图；图6(b)为两个动态障碍时的示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明做进一步详细说明。
本发明的一种基于瞬时碰撞点的无人机非协作式实时避障方法，为基于平行接近法“瞬时碰撞点”思想的无人机非协作式实时碰撞检测与避障航线规划方法。平行接近法是飞机追踪中常见的一种导引律。避障问题实际上和精确导引等问题有相似之处，不同的是前者要始终瞄准目标点，避障要求尽可能避免指向目标点。基于此思想可以很容易检测无人机和障碍之间可能发生的碰撞关系。同时，瞬时碰撞点周围和相关方向将是无人机飞行中尽量避免的 区域，本发明将这一区域引入到快速扩展随机树算法中，可以快速规划得到无人机的实时飞行航线，从而有效规避非协作障碍。
如图1所示，本发明方法的具体步骤为：
一种基于瞬时碰撞点的无人机实时避障方法主要包括障碍检测模块、障碍运动估计模块、碰撞检测模块、避障决策模块、避障航线重规划模块等。本方法采用的技术方案为：
(1)障碍探测，获取障碍的相对运动状态；
本实施例中，无人机的障碍探测可以根据实际需要采用光电/红外传感器和雷达混合的探测体制，实现在非协作式环境下的全天候全天时的障碍探测。其中，在白天、光照条件良好的条件下，采用可见光和雷达探测模式，在夜间和光照条件较差的条件下(雨、雪、雾)，采用红外和雷达探测模式。
光电/红外传感器主要用来形成视觉图像，在视觉图像获取后，首先进行预处理，通过对图像进行形态学操作来减少图像中的噪声和杂波，提高图像的信噪比，突出目标(即障碍)，抑制图像背景和噪声，检测出可能的障碍。经过预处理的无人机小目标的图像中的噪声得到了极大的削弱，小目标的信噪比也大为增强，然后采用迭代选择阈值的图像分割方法将障碍目标提取出来。
雷达传感器主要用来获取障碍的距离和方位，即将该障碍的雷达探测的距离和方位信息，作为障碍相对于本无人机的状态信息。
(2)障碍运动估计：基于卫星导航信息获取本机状态信息，计算出惯性空间障碍的运动状态，采用连续-离散扩展卡尔曼滤波完成障碍运动状态估计；
对无人机障碍的运动估计是基于惯性导航、卫星导航(GPS、北斗等)等导航信息，通过实时测得自身的运动状态信息，将测量到的目标相对于本无人机的状态信息进行解算，从而获得障碍相对于惯性空间的运动状态(目标位置、速度、加速度)。在此基础上，进一步通过对CV(匀速)模型、当前统计模型等典型目标运动模型进行分析，基于离散-连续扩展卡尔曼滤波方法实现障碍运动状态估计。
(3)碰撞冲突检测；
对于无人机的碰撞冲突检测是采用基于平行接近法为原理的障碍碰撞检测算法。该算法的基本思想是：在给定时间步长的时间窗口内，假定障碍物和无人机速度的大小和方向都不发生变化，以此时瞬时速度作为碰撞检测的计算所需的速度，以障碍物质心和无人机的质心 两者的连线为基准线。计算两者速度矢量在基准线上的垂线的长度，若两者相等处于相向运动，则可能会发生碰撞，速度矢量延长线的交点即为“瞬时碰撞点”，同时可计算出可能发生碰撞的时间。
(4)避障决策；
根据上述步骤(3)中对于碰撞冲突检测的结果，即是否存在碰撞的可能性以及即将碰撞的时间，合理采用相应的避障行为。
当为协作式障碍(如友方无人机)时，可依据空中交通规则，为了防止相撞，规定飞机在相对飞行相遇时，各自向右转躲避对方；在同向飞行时，如果要超越前方的飞机，后面的飞机要改变高度或从右侧超越。航向不同的飞机在空中交汇时，左方的飞机要为右面的飞机让路。本专利主要考虑非协作式障碍。
当为非协作式障碍时，并不会采用这种交通规则，主要依靠本机完成避障行为决策，在时间紧急条件下，采取应急机动控制，在有一定调整时间的前提下，进行航线的实时重规划，完成避障航线的实时调整。
(5)基于考虑瞬时碰撞点的快速扩展随机树算法的避障航线重规划；
快速扩展随机树算法是随机采样航线规划算法中性能比较优越的一种，通用性强，实现简单，它最独特的优点在于可以直接用于非完整约束的系统规划，适合于解决包含几何约束和动力学约束的避障航线规划问题。但基本快速扩展随机树算法在搜索过程中并没有考虑航线的综合代价，并且其目标节点选择的任意性使得扩展树的生长形状具有很大的随机性，这导致规划出来的航线也具有随机性，对同一条件下的规划过程缺乏可重复性，航线的性能往往是不可控的。换句话说，基本快速扩展随机树算法随机性太强，只能够保证高效快速的获得可行航线，无法获得规避动态障碍的较优航线。
本发明在上述基础上增加了考虑瞬时碰撞点，而不仅是当前障碍的空间位置，以此改进随机点的选择方式，引入航线评价启发信息，剪裁冗余节点，对航线进行平滑等，提高了规划航线的性能，由此设计了面向感知与规避的快速扩展随机树算法(SA-RRT)，实现了避障航线重规划功能。
在具体应用实例中，如图2所示，步骤(3)的具体计算步骤为：
(3.1)分别求出障碍物速度以及无人机速度与基准线的夹角分别为a，β，将障碍物速度Va和无人机的速度Vb分解到垂直于两者质心的连线，得到Va1和Vb1：
Va1＝Va sinα (1)
Vb1＝Vbsinβ (2)
考虑到假设条件无人机只能在前方探测到障碍，对在无人机后方的障碍物不进行探测。将约束条件加强，障碍物在无人机的前方需满足如下条件：
Vacosα>0 (3)
Vbcosβ>0 (4)
(3.2)判断：
若Va1＝Vb1，则在当前条件下飞行无人机与障碍物会发生碰撞，并得到瞬时碰撞点的坐标位置。在使用基于平行接近法原理的碰撞检测方法，若检测到能够发生碰撞，则碰撞的时间约束可以通过计算得知，即可以得出无人机和障碍物相距距离为S，则不进行避障发生碰撞的时间Tcollision为：
即在不考虑其他情况的条件下，无人机完成避障行为的时间t<Tcollision。
但通常情况下，Va1＝Vb1不一定成立。由于无人机和障碍并不是质点模型，所以它们之间存在一个安全距离RSafe，在小于此距离内，无人机由于飞行性能限制，无法及时转弯导致无法避开障碍，碰撞将会发生。则若下式成立，碰撞仍然会发生。
碰撞时间即为：
如果空中存在多个障碍，则计算相互之间的碰撞关系；若有可能发生碰撞，则得到多个瞬时碰撞点，从而确定安全通行区域和受约束的转弯角度。
在具体应用实例中，如图3和图4所示，步骤(5)的具体计算步骤为：
(5.1)：以当前无人机的位置作为初始节点Nodeinit，初始化搜索树结构，只包含一个节点，如图3所示，根据预测碰撞算法，得到预测碰撞时间Tcollision，以瞬时碰撞点为圆心，以 无人机安全距离RSafe为半径，形成预测碰撞区域Regioncollision，将当前本机位置、预测碰撞点和障碍位置形成的三角形区域，称为航线规避区Regionavoid。
(5.2)基于基本RRT流程，按照以下步骤扩展搜索树：
(5.2.1)产生随机数P∈[0,1]，如果P<PG则选择Nodegoal作为目标点Nodetarget，否则在未搜索区域范围内产生一个位于障碍区域外产生随机点Noderand。若随机点Noderand未落入预测碰撞区和航线规避区，则选取Noderand作为目标点Nodetarget，否则继续生成随机点Noderand。如图3所示，分别落入了航线规避区Regionavoid和预测碰撞区域Regioncollision，则将这两个随机点排除，选择作为目标点Nodetarget。
(5.2.2)在当前生成树T中，查询与Nodetarget最近的节点，记为Nodenear，根据飞机行进步长，计算得到行进节点Nodetemp，并判断与Nodenear的运动时间t是否落入预测碰撞时间Tcollision内。如果t在Tcollision内，则继续判断Nodetemp是否落入航线规避区Regionavoid和预测碰撞区域Regioncollision，如果没有，则转入(5.2.3)，否则舍弃随机点Nodetemp并转入(5.2.1)。
(5.2.3)将扩展节点Nodetemp记为Nodenew，并加入搜索树T中，作为Nodenear的子节点；
(5.2.4)如果||Nodenew-Nodegoal||≤ε，则搜索到目标点，跳到步骤(5.3)；否则更新计算航线规避区Regionavoid和预测碰撞区域Regioncollision以及碰撞时间Tcollision，并返回步骤(5.2)。
(5.2.5)如果搜索时间超过搜索时间上限Tmax，则强制结束扩展，跳到步骤(5.3)。
(5.3)返回形成的扩展搜索树，获得Nodeinit从到Nodegoal的航线。如果是强制结束，则返回从Nodeinit到距离Nodegoal最近的叶节点的航线。
在一个具体应用实例中，设定无人机扩展步长为100(扩展步长由无人机在改变飞行姿态前必须直飞的最小距离决定)，分无人机遇到静态障碍和动态障碍两种情况。静态障碍假设为一半径为5m的球体，在空中悬浮不动。动态障碍为飞行速度与无人机相同的飞行器，分别设置3个静态障碍和2个动态障碍进行避障实验。
用SA-RRT算法进行避障航线重规划，运行10次，并与RRT进行比较，计算平均扩展节点数和规划耗费时间，实验结果见下表1。通过下表1可以看出SA-RRT算法在规避静态障碍时比规避动态障碍扩展节点数少，耗时也少。主要原因是对于静态障碍物空中障碍物只需要进行一次探测便可知道障碍物具体的位置，只需要一次计算便可改变无人机的俯仰和偏航角来进行规避。而对于动态障碍物，由于其运动状态运动速度的改变，空间位置在发生着 不断变化，因此需要不断的对航线进行规划，因此规避动态障碍物其扩展节点数多，耗时长。
表1不同障碍数量情况下算法特性
静态障碍条件下，SA-RRT算法规划得到航线在Matlab平台上的三维显示如图5。球体代表静态障碍，曲线1、曲线2、曲线3为无人机重规划航线。无人机在探测到静态障碍时，重新规划避障航线绕过障碍物。动态障碍条件下，SA-RRT算法规划得到航线在Matlab平台上的三维显示如图6。曲线4、曲线6和曲线8代表动态空中障碍物的飞行轨迹，曲线5和曲线7为无人机重规划航线。无人机探测到侧面飞来的障碍物，重新规划航迹，降低飞行高度，从障碍航迹下方绕过，紧接着又有前方发现的障碍物，无人机再次重规划航迹避开障碍。综上可知，本发明采用的无人机实时碰撞检测与避障航线规划方法能够准确的检测出障碍，并能有效的实现规避，对无人机的机载感知与规避问题具有重要的理论意义和实用价值。
以上仅是本发明的优选实施方式，本发明的保护范围并不仅局限于上述实施例，凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理前提下的若干改进和润饰，应视为本发明的保护范围。
Claims (5)
1.一种基于瞬时碰撞点的无人机非协作式实时避障方法，其特征在于，步骤为：
(1)障碍探测：获取障碍的相对运动状态；
(2)障碍运动估计：基于卫星导航信息获取本机状态信息，计算出惯性空间障碍的运动状态；
(3)碰撞冲突检测：判断是否会与障碍发生碰撞；
(4)避障决策：基于步骤(3)的检测结果，做出避障决策；所述步骤(4)包括：
当为协作式障碍时，依据空中交通规则，规定飞机在相对飞行相遇时，各自向右转躲避对方；在同向飞行时，如果要超越前方的飞机，后面的飞机要改变高度或从右侧超越；航向不同的飞机在空中交汇时，左方的飞机要为右面的飞机让路；
当为非协作式障碍时，依靠本机完成避障行为决策；在时间紧急条件下，采取应急机动控制；在有调整时间的前提下，进行航线的实时重规划，完成避障航线的实时调整；
(5)基于考虑瞬时碰撞点的快速扩展随机树算法的避障航线重规划：基于瞬时碰撞点，引入航线评价启发信息，实现避障航线重规划；
所述步骤(5)的具体步骤为：
(5.1)：以当前无人机的位置作为初始节点Nodeinit，初始化搜索树结构，只包含一个节点；根据预测碰撞算法，得到预测碰撞时间Tcollision，以瞬时碰撞点为圆心，以无人机安全距离RSafe为半径，形成预测碰撞区域Regioncollision，将当前本机位置、预测碰撞点和障碍位置形成的三角形区域，称为航线规避区Regionavoid；
(5.2)基于基本RRT流程，按照以下步骤扩展搜索树：
(5.2.1)产生随机数P∈[0,1]，如果P<PG则选择Nodegoal作为目标点Nodetarget，否则在未搜索区域范围内产生一个位于障碍区域外产生随机点Noderand；若随机点Noderand未落入预测碰撞区和航线规避区，则选取Noderand作为目标点Nodetarget，否则继续生成随机点Noderand；分别落入了航线规避区Regionavoid和预测碰撞区域Regioncollision，则将这两个随机点排除，选择作为目标点Nodetarget；
(5.2.2)在当前生成树T中，查询与Nodetarget最近的节点，记为Nodenear，根据飞机行进步长，计算得到行进节点Nodetemp，并判断与Nodenear的运动时间t是否落入预测碰撞时间Tcollision内；如果t在Tcollision内，则继续判断Nodetemp是否落入航线规避区Regionavoid和预测碰撞区域Regioncollision，如果没有，则转入(5.2.3)，否则舍弃随机点Nodetemp并转入(5.2.1)；
(5.2.3)将扩展节点Nodetemp记为Nodenew，并加入搜索树T中，作为Nodenear的子节点；
(5.2.4)如果||Nodenew-Nodegoal||≤ε，则搜索到目标点，跳到步骤(5.3)；否则更新计算航线规避区Regionavoid和预测碰撞区域Regioncollision以及碰撞时间Tcollision，并返回步骤(5.2)；
(5.2.5)如果搜索时间超过搜索时间上限Tmax，则强制结束扩展，跳到步骤(5.3)；
(5.3)返回形成的扩展搜索树，获得Nodeinit从到Nodegoal的航线；如果是强制结束，则返回从Nodeinit到距离Nodegoal最近的叶节点的航线。
2.根据权利要求1所述的基于瞬时碰撞点的无人机非协作式实时避障方法，其特征在于，所述步骤(3)的具体步骤为：
(3.1)分别求出障碍物速度以及无人机速度与基准线的夹角分别为a，β，将障碍物速度Va和无人机的速度Vb分解到垂直于两者质心的连线，得到Va1和Vb1：
Va1＝Vasinα (1)
Vb1＝Vbsinβ (2)
将约束条件加强，障碍物在无人机的前方需满足如下条件：
Vacosα>0 (3)
Vbcosβ>0 (4)
(3.2)判断：
若Va1＝Vb1，则在当前条件下飞行无人机与障碍物会发生碰撞，并得到瞬时碰撞点的坐标位置；若检测到能够发生碰撞，碰撞的时间约束通过计算得知，得出无人机和障碍物相距距离为S，不进行避障发生碰撞的时间Tcollision为：
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>l</mi>
<mi>l</mi>
<mi>i</mi>
<mi>s</mi>
<mi>i</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mi>S</mi>
<mrow>
<msub>
<mi>V</mi>
<mi>a</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>b</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
即在不考虑其他情况的条件下，无人机完成避障行为的时间t<Tcollision；
无人机和障碍之间存在一个安全距离RSafe，在小于此距离内，碰撞仍将会发生，即则若下式成立，碰撞仍然会发生：
<mrow>
<mfrac>
<mrow>
<mi>S</mi>
<mo>-</mo>
<msub>
<mi>R</mi>
<mrow>
<mi>S</mi>
<mi>a</mi>
<mi>f</mi>
<mi>e</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>V</mi>
<mi>a</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>b</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mo>&CenterDot;</mo>
<mo>|</mo>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>V</mi>
<mrow>
<mi>b</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mo>|</mo>
<mo><</mo>
<msub>
<mi>R</mi>
<mrow>
<mi>S</mi>
<mi>a</mi>
<mi>f</mi>
<mi>e</mi>
</mrow>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
碰撞时间为：
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>l</mi>
<mi>l</mi>
<mi>i</mi>
<mi>s</mi>
<mi>i</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>S</mi>
<mo>-</mo>
<msub>
<mi>R</mi>
<mi>S</mi>
</msub>
</mrow>
<mrow>
<msub>
<mi>V</mi>
<mi>a</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>b</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
3.根据权利要求2所述的基于瞬时碰撞点的无人机非协作式实时避障方法，其特征在于，所述步骤(3)中，如果空中存在多个障碍，则计算相互之间的碰撞关系；若有可能发生碰撞，则得到多个瞬时碰撞点。
4.根据权利要求1～3中任意一项所述的基于瞬时碰撞点的无人机非协作式实时避障方法，其特征在于，所述步骤(1)中，无人机的障碍探测采用光电/红外传感器和雷达混合的探测体制；所述光电/红外传感器用来形成视觉图像，然后采用图像分割方法将障碍目标提取出来；所述雷达传感器用来获取障碍的距离和方位，作为障碍相对于本无人机的状态信息。
5.根据权利要求1～3中任意一项所述的基于瞬时碰撞点的无人机非协作式实时避障方法，其特征在于，所述步骤(2)中，对无人机障碍的运动估计是基于导航信息，通过实时测得自身的运动状态信息，将测量到的目标相对于本无人机的状态信息进行解算，获得障碍相对于惯性空间的运动状态；通过对典型目标运动模型进行分析，基于离散-连续扩展卡尔曼滤波方法实现障碍运动状态估计。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410706448.5A CN104597910B (zh) | 2014-11-27 | 2014-11-27 | 一种基于瞬时碰撞点的无人机非协作式实时避障方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410706448.5A CN104597910B (zh) | 2014-11-27 | 2014-11-27 | 一种基于瞬时碰撞点的无人机非协作式实时避障方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104597910A CN104597910A (zh) | 2015-05-06 |
| CN104597910B true CN104597910B (zh) | 2017-11-07 |
Family
ID=53123765
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410706448.5A Active CN104597910B (zh) | 2014-11-27 | 2014-11-27 | 一种基于瞬时碰撞点的无人机非协作式实时避障方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104597910B (zh) |
Families Citing this family (55)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104932526B (zh) * | 2015-05-29 | 2020-08-28 | 深圳市大疆创新科技有限公司 | 一种飞行设备的控制方法及飞行设备 |
| CN105353768B (zh) * | 2015-12-08 | 2017-12-26 | 清华大学 | 狭窄空间内基于随机采样的无人机轨迹规划方法 |
| CN105843225B (zh) * | 2016-03-31 | 2022-01-25 | 纳恩博（北京）科技有限公司 | 一种数据处理方法及设备 |
| CN105843253A (zh) * | 2016-04-08 | 2016-08-10 | 北京博瑞空间科技发展有限公司 | 无人机的路径规划方法及系统 |
| CN105759829A (zh) * | 2016-04-12 | 2016-07-13 | 深圳市龙云创新航空科技有限公司 | 基于激光雷达的微型无人机操控方法及系统 |
| CN105892489B (zh) * | 2016-05-24 | 2019-09-10 | 国网山东省电力公司电力科学研究院 | 一种基于多传感器融合的自主避障无人机系统及控制方法 |
| DE102016211587A1 (de) | 2016-06-28 | 2017-12-28 | Robert Bosch Gmbh | Verfahren und Vorrichtung zum Steuern eines Fahrzeugs |
| CN107783548B (zh) * | 2016-08-25 | 2021-02-26 | 大连楼兰科技股份有限公司 | 基于多传感器信息融合技术的数据处理方法 |
| CN107783544B (zh) * | 2016-08-25 | 2021-02-26 | 大连楼兰科技股份有限公司 | 一种控制单旋翼植保无人机避障飞行的方法 |
| CN106384544A (zh) * | 2016-09-21 | 2017-02-08 | 江西天祥通用航空股份有限公司 | 一种针对电力线的预警方法及系统 |
| CN106205223A (zh) * | 2016-09-21 | 2016-12-07 | 江西天祥通用航空股份有限公司 | 一种针对障碍物的预警方法及系统 |
| CN106292708A (zh) * | 2016-10-09 | 2017-01-04 | 北京国泰北斗科技有限公司 | 无人机避障控制方法及装置 |
| CN106444845B (zh) * | 2016-10-14 | 2019-03-05 | 中国人民解放军国防科学技术大学 | 一种无信息条件下的多uav协同搜索方法 |
| CN106919181A (zh) * | 2016-10-20 | 2017-07-04 | 湖南大学 | 一种无人机避障方法 |
| CN106774401A (zh) * | 2016-12-28 | 2017-05-31 | 深圳大漠大智控技术有限公司 | 一种无人机编队变换阵型时的轨迹自动生成方法 |
| CN106774425B (zh) * | 2017-03-13 | 2019-05-21 | 南昌航空大学 | 一种无人机飞行导航的方法及系统 |
| CN106695802A (zh) * | 2017-03-19 | 2017-05-24 | 北京工业大学 | 基于多自由度机械臂的改进式rrt*的避障运动规划方法 |
| CN107085437A (zh) * | 2017-03-20 | 2017-08-22 | 浙江工业大学 | 一种基于eb‑rrt的无人机航迹规划方法 |
| CN107241766B (zh) * | 2017-04-26 | 2020-04-21 | 北京邮电大学 | 基于大规模天线的毫米波前传波束动态避障方法 |
| CN107272731B (zh) * | 2017-06-05 | 2020-10-02 | 陈金良 | 无人机自动避撞系统 |
| CN107402579A (zh) * | 2017-07-07 | 2017-11-28 | 深圳市华琥技术有限公司 | 一种基于无人机的雾霾检测方法 |
| CN107289945A (zh) * | 2017-07-07 | 2017-10-24 | 深圳市华琥技术有限公司 | 一种无人机导航方法 |
| CN107357309A (zh) * | 2017-07-07 | 2017-11-17 | 深圳市华琥技术有限公司 | 一种基于无人机的远程救援方法及无人机 |
| CN107291100B (zh) * | 2017-07-07 | 2020-07-28 | 中航华东光电深圳有限公司 | 一种基于无人机的监控方法 |
| CN107390715A (zh) * | 2017-07-07 | 2017-11-24 | 深圳市华琥技术有限公司 | 一种基于无人机的喷药控制方法 |
| CN107719712B (zh) * | 2017-09-11 | 2020-05-15 | 上海宇航系统工程研究所 | 可视范围优先的在轨操作规划方法 |
| CN108521808B (zh) * | 2017-10-31 | 2021-12-07 | 深圳市大疆创新科技有限公司 | 一种障碍信息显示方法、显示装置、无人机及系统 |
| CN109960273B (zh) * | 2017-12-22 | 2022-05-17 | 杭州海康机器人技术有限公司 | 无人机的飞行控制方法、装置及存储介质 |
| EP3531222A1 (en) * | 2017-12-26 | 2019-08-28 | Autel Robotics Co., Ltd. | Path planning method and device for unmanned aerial vehicle, and flight management method and device |
| CN107918403A (zh) * | 2017-12-31 | 2018-04-17 | 天津津彩物联科技有限公司 | 一种多无人机飞行轨迹协同规划的实现方法 |
| JP6974247B2 (ja) * | 2018-04-27 | 2021-12-01 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co., Ltd | 情報処理装置、情報提示指示方法、プログラム、及び記録媒体 |
| CN108776492B (zh) * | 2018-06-27 | 2021-01-26 | 电子科技大学 | 一种基于双目相机的四轴飞行器自主避障与导航方法 |
| CN109298708B (zh) * | 2018-08-31 | 2021-08-17 | 中船重工鹏力（南京）大气海洋信息系统有限公司 | 一种融合雷达与光电信息的无人艇自主避障方法 |
| CN109582032B (zh) * | 2018-10-11 | 2021-10-12 | 天津大学 | 多旋翼无人机在复杂环境下的快速实时避障路径选择方法 |
| CN109407705A (zh) * | 2018-12-14 | 2019-03-01 | 厦门理工学院 | 一种无人机躲避障碍物的方法、装置、设备和存储介质 |
| CN109799823B (zh) * | 2019-01-29 | 2022-01-18 | 珠海云洲智能科技股份有限公司 | 一种海洋测量方法、电子设备及存储介质 |
| CN110068337B (zh) * | 2019-04-25 | 2023-09-19 | 安徽师范大学 | 用于传感器节点充电的无人机调度方法及系统 |
| CN110659771B (zh) * | 2019-09-04 | 2022-11-22 | 中国航空工业集团公司沈阳飞机设计研究所 | 飞机协同航路规划方法 |
| CN110954104B (zh) * | 2019-10-29 | 2021-12-28 | 中国人民解放军战略支援部队航天工程大学 | 一种航天器抵近操作路径规划方法 |
| CN110989679B (zh) * | 2019-12-19 | 2023-10-03 | 中国人民解放军空军工程大学 | 基于经验移植的无人机集群穿越迷障决策方法 |
| CN111177851B (zh) * | 2019-12-27 | 2023-05-02 | 北航（四川）西部国际创新港科技有限公司 | 一种无人机运行安全风险评估中对地风险的评估方法 |
| CN110824453A (zh) * | 2020-01-10 | 2020-02-21 | 四川傲势科技有限公司 | 一种基于图像跟踪与激光测距的无人机目标运动估计方法 |
| CN112489500B (zh) * | 2020-11-24 | 2022-03-25 | 中国电子科技集团公司第二十八研究所 | 一种基于几何视景模型的短期飞行冲突检测与避免方法 |
| CN112595337B (zh) * | 2020-12-01 | 2023-08-15 | 苏州欧菲光科技有限公司 | 避障路径规划方法、装置、电子装置、车辆及存储介质 |
| CN112578389B (zh) * | 2020-12-08 | 2021-09-24 | 浙江景奕智能控制技术有限公司 | 一种多源融合的rov实时路径规划方法 |
| CN112506222A (zh) * | 2020-12-10 | 2021-03-16 | 中国南方电网有限责任公司超高压输电公司天生桥局 | 一种无人机智能化避障方法及装置 |
| CN112904889B (zh) * | 2021-01-15 | 2022-03-01 | 安徽工业大学 | 一种飞行机器人避障装置及其避障方法 |
| CN113031008A (zh) * | 2021-03-12 | 2021-06-25 | 中国电子科技集团公司第二十研究所 | 一种具有主动探测海面威胁的前视预测告警方法 |
| CN113469037A (zh) * | 2021-06-30 | 2021-10-01 | 广州大学 | 一种基于机器视觉的水下无人机智能避障方法和系统 |
| CN114442659B (zh) * | 2021-12-29 | 2023-11-07 | 宜昌测试技术研究所 | 一种无人飞行器自主规避移动障碍方法及系统 |
| CN114852341A (zh) * | 2022-04-29 | 2022-08-05 | 天津远洋航空集团有限公司 | 物流用无人机 |
| CN114911266B (zh) * | 2022-06-15 | 2023-05-09 | 南京邮电大学 | 一种无人机搜索航路建立方法及装置 |
| CN115657704B (zh) * | 2022-08-29 | 2023-12-01 | 广州建通测绘地理信息技术股份有限公司 | 一种飞行器被动式避障导航方法、装置及计算机设备 |
| CN116185079B (zh) * | 2023-04-28 | 2023-08-04 | 西安迈远科技有限公司 | 一种基于自适应巡航的无人机施工巡检航线规划方法 |
| CN117406729B (zh) * | 2023-10-19 | 2024-10-22 | 中国民航大学 | 一种evtol避让系统的rta设计方法、设备及介质 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5581250A (en) * | 1995-02-24 | 1996-12-03 | Khvilivitzky; Alexander | Visual collision avoidance system for unmanned aerial vehicles |
| US7818127B1 (en) * | 2004-06-18 | 2010-10-19 | Geneva Aerospace, Inc. | Collision avoidance for vehicle control systems |
| CN202046439U (zh) * | 2011-04-26 | 2011-11-23 | 山东电力研究院 | 电力巡线无人直升机超低空飞行障碍规避子系统 |
| CN102707724B (zh) * | 2012-06-05 | 2015-01-14 | 清华大学 | 一种无人机的视觉定位与避障方法及系统 |
| CN103869822B (zh) * | 2014-04-01 | 2016-09-07 | 西北工业大学 | 多旋翼无人机感知与规避系统及其规避方法 |
-
2014
- 2014-11-27 CN CN201410706448.5A patent/CN104597910B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN104597910A (zh) | 2015-05-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104597910B (zh) | 一种基于瞬时碰撞点的无人机非协作式实时避障方法 | |
| CN107272731B (zh) | 无人机自动避撞系统 | |
| Tang et al. | Systematic review of collision-avoidance approaches for unmanned aerial vehicles | |
| US7818127B1 (en) | Collision avoidance for vehicle control systems | |
| EP3276440A1 (en) | Sense and avoid maneuvering | |
| EP2226779A1 (en) | Method of collision prediction between an air vehicle and an airborne object | |
| Griffiths et al. | Obstacle and terrain avoidance for miniature aerial vehicles | |
| CN106919181A (zh) | 一种无人机避障方法 | |
| CN108319291A (zh) | 一种基于安全边界分析的无人机认知防碰撞控制方法 | |
| WO2017168423A1 (en) | System and method for autonomous guidance of vehicles | |
| CN108759839A (zh) | 一种基于态势空间的无人飞行器路径规划方法 | |
| CN102854883A (zh) | 一种无人机动态紧急避撞区的建模方法 | |
| US11763555B2 (en) | System and method for ground obstacle detection and database management | |
| CN104267738A (zh) | 一种无人机防碰撞系统 | |
| Krozel et al. | Conflict detection and resolution for future air transportation management | |
| Lin et al. | A fast obstacle collision avoidance algorithm for fixed wing uas | |
| Butt et al. | A review of perception sensors, techniques, and hardware architectures for autonomous low-altitude UAVs in non-cooperative local obstacle avoidance | |
| Shish et al. | Survey of capabilities and gaps in external perception sensors for autonomous urban air mobility applications | |
| JP2021536394A (ja) | 飛行中の航空機と航空機の航跡の回避 | |
| CN116564140A (zh) | 一种基于通航救援的低空实时飞行冲突探测与解脱方法 | |
| Palmer et al. | Co-operative collision avoidance for unmanned aerial vehicles using both centralised and decoupled approaches | |
| Boskovic et al. | Sensor and tracker requirements development for sense and avoid systems for unmanned aerial vehicles | |
| Lin et al. | Conflict detection and resolution model for low altitude flights | |
| Albaker et al. | Autonomous unmanned aircraft collision avoidance system based on geometric intersection | |
| Alves | Path planning and collision avoidance algorithms for small RPAS |
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 |