CN110456823A - 一种针对无人机计算与存储能力受限的双层路径规划方法 - Google Patents
一种针对无人机计算与存储能力受限的双层路径规划方法 Download PDFInfo
- Publication number
- CN110456823A CN110456823A CN201910795321.8A CN201910795321A CN110456823A CN 110456823 A CN110456823 A CN 110456823A CN 201910795321 A CN201910795321 A CN 201910795321A CN 110456823 A CN110456823 A CN 110456823A
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- barrier
- follows
- unmanned
- indicate
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 61
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 20
- 230000007613 environmental effect Effects 0.000 claims abstract description 12
- 238000005516 engineering process Methods 0.000 claims abstract description 9
- 230000004888 barrier function Effects 0.000 claims description 63
- WSFSSNUMVMOOMR-UHFFFAOYSA-N Formaldehyde Chemical compound O=C WSFSSNUMVMOOMR-UHFFFAOYSA-N 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 7
- 230000001737 promoting effect Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000012512 characterization method Methods 0.000 claims description 3
- 239000000446 fuel Substances 0.000 claims description 3
- 230000006870 function Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 239000002245 particle Substances 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 241000251468 Actinopterygii Species 0.000 claims description 2
- 238000013500 data storage Methods 0.000 abstract description 5
- 230000002093 peripheral effect Effects 0.000 abstract description 5
- 238000013461 design Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000036632 reaction speed Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000005204 segregation Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
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/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种针对无人机计算与存储能力受限的双层路径规划方法,针对无人机计算与存储能力受限问题,首先,基于已有地图信息并考虑无人机自身动力学性能限制,利用鱼群算法生成初始参考航迹;其次,利用机载传感器获取无人机及周围障碍物等环境信息,并利用三维碰撞锥技术判断障碍物是否对无人机造成威胁;再次,若有威胁,利用基于马尔科夫过程的前向式搜索法生成局部避障路径,按照局部规划航迹进行飞行,若无威胁,无人机沿参考航迹继续飞行;最后,避障完成,无人机继续飞行,直到抵达参考航迹期望点。本发明具有收敛速度快、数据存储负担小、安全性高等优点,可用于无人机安全快速避障,还可推广到无人车、无人飞行器的自主避障。
Description
技术领域
本发明涉及一种针对无人机计算与存储能力受限的双层路径规划方法,应用于无人机安全快速避障,还可推广到无人车、无人飞行器的自主避障。
背景技术
无人机是一种无需飞行员的载具,通常可通过遥控和自动驾驶来控制。相比于有人驾驶的飞机,无人机在成本,灵活性,以及团队合作性具有显著优势。近年来,无人机广泛应用于军事和民用领域,包括边境巡逻,远程打击,电力检查,以及航拍等。与此同时,诸多负面事件,包括无人机“黑飞”,坠飞事故频繁出现于新闻报道。仅2017年4月在我国杭州、上海地区就有13起无人机干扰航班运行的报道,提醒我们无人机的发展还存在诸多问题。因此,亟需提升复杂环境中受计算机计算与数据存储能力受限的无人机避障能力。
早期关于无人机路径规划的研究重点是基于已经获取地图信息,设计一条离线轨迹,使无人机从起点飞到目的地,同时规避离线地图中的障碍物。典型的离线路径规划方法包括最佳优先搜索法,A*法和鱼群算法等。然而真实的实时飞行环境通常是难以离线获得的,实际的飞行环境中往往存在移动障碍物,此时离线规划的轨迹已经无法保证无人机的飞行安全。
相对于离线路径规划算法,实时避障的思路是通过机载传感器,实时获取无人机周边环境信息,从而设计一种局部路径规划方法。在无人机碰撞检测机制发出危险警告时,重新规划一条新的从当前位置到终点的轨迹,规避突发的冲突。经典的局部路径规划算法包括势场法、D*以及动态规划方法。然而上述局部路径规划算法存在各自的缺陷,例如势场法存在的局部陷阱有可能导致策略失效,D*和动态规划法需要花费大量时间,难以满足无人机系统对高安全快速性的要求。
对于路径规划问题,无人机航路规划早已在国内外得到广泛的研究与应用,例如美国NASA正在测试利用动态规划法,作为其研究的无人机ACASXu的避障算法。民用科技公司大疆则在其产品“精灵”中采用双目视觉法来实现避障。中国专利CN103697896A针对存在敌方雷达警戒区和高度超过无人机飞行高度的地形凸起等障碍物的情况,提出了基于HOCAOGLU算法,进行路径平滑处理,提升路径的多样性。中国专利CN103365299B根据人类避碰行为的思想,提出了模拟人类避障行为的航路规划策略,能够快速解算出平滑有效的安全航路,且满足无人机机动性能约束,可以实现无人机以尽量少的飞行能耗代价,快速安全的避障。然而,上述研究都没有将计算机计算与存储能力受限情况考虑在内。
综上,无人机飞行环境的动态性和不确定性、计算机数据存储能力受限等问题对无人机高安全快速性要求带来了挑战,有必要从算法的角度开发一种能降低计算机数据存储负担同时提升收敛速度的无人机路径规划系统,从而提升无人机安全、快速避障的能力。
发明内容
本发明的技术解决问题是:针对现有方法对无人机飞行环境的动态性和不确定性、计算机数据存储能力受限导致无人机避障能力不足的问题,提供一种针对无人机计算与存储能力受限的双层路径规划方法,具有收敛速度快、数据存储负担小、安全性高等优点,可用于无人机安全快速避障,还可推广到无人车、无人飞行器的自主避障。
本发明的技术解决方案为:针对无人机计算与存储能力受限的问题,首先,基于已有地图信息并考虑无人机自身动力学性能限制,利用鱼群算法生成初始参考航迹;其次,利用机载传感器获取无人机及周围障碍物等环境信息,并利用三维碰撞锥技术判断障碍物是否对无人机造成威胁;再次,若有威胁,利用基于马尔科夫过程的前向式搜索法生成局部避障路径,按照局部规划航迹进行飞行,若无威胁,无人机沿参考航迹继续飞行;最后,避障完成,无人机继续飞行,直到抵达参考航迹期望点,完成针对无人机计算与存储能力受限的双层路径规划方法。具体实施步骤如下:
第一步,基于已有地图信息并考虑无人机自身动力学性能限制,利用鱼群算法生成初始参考航迹:
首先,建立用于表征无人机飞行过程的动力学模型、无人机飞行过程中所必须满足的动力学限制、静态障碍物和动态障碍物的空间存在范围模型。
建立用于表征无人机飞行过程的动力学模型,表示如下:
其中,(x,y,z)表示飞机机身质心位置在地面惯性坐标系中的空间坐标,(θ,ψ)分别表示俯仰角和偏航角,V代表飞机速度。
建立无人机飞行过程中所必须满足的动力学限制,包括无人机飞行速度范围,最小转弯半径,以及与半径相关联的限制条件,表示如下:
其中,(Vmin,Vmax)分别表示最小和最大飞行速度,(r,rmin)表示转弯半径与最小转弯半径,g和φmax表示常数重力加速度与最大滚转角。
无人机飞行过程中分别存在静态障碍物以及动态障碍物,这些障碍物的空间存在范围表示如下:
其中,(xobs,yobs,zobs)和(xobs(t),yobs(t),zobs(t))分别表示静态与移动障碍物中心位置坐标,(a,b,c,p,q,σ)用于表征静态障碍物尺寸大小与形状,ξ表示动态障碍物半径大小;
其次,根据表征无人机飞行过程的动力学模型、无人机飞行过程中所必须满足的动力学限制、静态障碍物和动态障碍物的空间存在范围模型,建立无人机安全飞行空域即无碰撞空间,并明确无人机起飞前获得的初始信息。
无人机飞行过程中需要规避静态障碍物以及动态障碍物,对安全飞行空域即无碰撞空间建模,表示如下:
其中,Cfree表示无碰撞空域,λ≥1是用于提升飞行安全的膨胀系数;
明确无人机起飞前获得的初始信息,包括环境信息:无人机起点(x0,y0,z0),目的地(xd,yd,zd),禁飞区,无人机自身动力学限制:rmin,Vmin。
最后,利用鱼群算法规划无人机从起点到达目的地的初始参考航迹,同时将无人机物理学限制考虑在内,得到一条满足航迹平滑、燃油经济、高安全的飞行轨迹(Xoptimal),该算法目标函数f(X)以最小值为最优,设置如下:
其中,f1(X)对应于无人机航迹平滑指标,(xi,yi,zi),(xi+1,yi+1,zi+1),(xi+2,yi+2,zi+2)表示参考轨迹上的三个离散点,αi表示三个相邻路径点夹角。
其中,f2(X)对应于无人机燃油经济指标。
其中,f3(X)对应于无人机安全指标,Ds表示设定的最小安全距离,β1表示无人机与障碍物的最小距离,β2>>0表示碰撞的惩罚。
f(X)=ρ1f1(X)+ρ2f2(X)+ρ3f3(X)
其中,0<ρ1<1,0<ρ2<1,和0<ρ3<1分别表示三个考虑因素所占的权重。
对无人机航迹平滑指标、燃油经济指标和安全指标进行加权组合,计算满足甲醛组合后的综合指标f(X)的最小值,当综合指标f(X)取得最小值时,得到最优的初始参考航迹Xoptimal。
第二步,利用机载传感器获取无人机及周围障碍物等环境信息,并利用三维碰撞锥技术判断障碍物是否对无人机造成威胁:
在飞行过程中,利用机载传感器,包括但不限于陀螺仪,加速度计,激光雷达,视觉系统,可以获得当前无人机自身的位置速度信息,以及无人机一定范围内环境的信息。其中有效检测环境范围,表示如下:
S={S|(x-x′)2+(y-y′)2+(z-z′)2≤R2}
其中,S和R分别表示检测范围及其半径;x、y、z分别表示无人机机身质心位置;x′、y′、z′分别表示无人机机身质心移动速度。
当检测的无人机周围出现未知障碍物时,根据无人机与障碍物的相对位置及速度信息,利用三维碰撞锥方法预测,按照初始规划航迹继续飞行,是否会出现碰撞。若否,则执行第四步;如果是,进入第三步;
构建三维碰撞锥,用于预测无人机是否会与检测到的障碍物发生碰撞。无人机附近检测到威胁,无人机与检测到的障碍物之间相对速度和位置以及速度夹角,表示如下:
其中,和PO表示具有威胁的障碍物的速度和位置坐标。根据无人机的安全距离d1,可以以无人机为质点构建一个无人机安全球形区域,同样在具有威胁的障碍物上也可以构建一个相对安全的球形区域。连接无人机和具有威胁的障碍物质心,从无人机质心到具有威胁的障碍物球形区域做切线可以构建一个三维碰撞锥。三维碰撞锥的半夹角表示如下:
其中,d表示无人机和具有威胁的障碍物间的直线距离。从而可以得到无人机和具有威胁的障碍物间无碰撞条件为:
α0>α
其中,α0表示从无人机质心到具有威胁的障碍物的球形区域的安全夹角,α表示三维碰撞锥的半夹角。
第三步,根据第二步中的判断,若有威胁,利用基于马尔科夫过程的前向式搜索法生成局部避障路径,按照局部规划航迹进行飞行,若无威胁,无人机沿第一步中的参考航迹继续飞行:
当α0≤α,则无人机进入局部路径规划模式,利用前向式搜索法规划一条新的避障路径。
将飞行空间以同样大小的立方体划分,每个立方体对应加上序号,得到一组状态集合S。无人机从当前状态,在飞行动作集合A中选择一个前进动作a,按照一定的概率分布到达下一个状态。当到达下一个状态时,给予无人机一个奖励值R。用表示在状态S执行动作a获得的奖励。
碰撞预测结果与奖励相联系,用于加速在线计算,当|α0|-α>0时,无人机与具有威胁的障碍物朝着距离加大的方向飞行,则赋予当前时刻采取动作at一个正的奖励值,其他动作奖励值为零,表示如下:
当|α0|-α≤0时,无人机与具有威胁的障碍物朝着距离减小的方向飞行且将导致碰撞,则赋予at相邻动作正的奖励值,其他动作奖励值为零,表示如下:
此外,为了缓解计算机存储负担,在获得每一步的决策结果后,初始化当前状态,避免将过多的状态引入局部计算中。根据这种基于马尔科夫过程的前向式搜索法生成局部避障路径,并时无人机按照局部规划航迹进行飞行。
第四步,根据第三步中的避障路径进行避障,避障完成,无人机继续飞行,直到抵达参考航迹期望点,完成针对无人机计算与存储能力受限的双层路径规划方法:
当未知障碍物规避完成后,返回初始规划路径;根据终止条件,判断是否到达目的地。若是,则任务完成。若否,则返回第三步。终止条件表示为:
其中,(xtar,ytar,ztar)表示目的地空间坐标,x(t)、y(t)、z(t)分别表示在时间t时的无人机机身质心位置。
本发明与现有技术相比的优点在于:本发明明确考虑到无人机计算机硬件的计算性能限制,在采用的局部路径规划算法中将碰撞预测结果作为启发信息加入的在线计算过程中,有效提升了无人机应对未知障碍物的反应速度;相比于传统动态规划计算中忽略起始状态信息,把全局环境的全部状态都纳入局部计算,影响在线收敛速度的问题,本发明每次局部计算中把当前状态初始化,并且代入到局部规划计算中,从而有效减少局部计算涉及的状态数量,减轻计算机存储负担。相比已有专利中的路径规划系统,本发明采用鱼群算法和前向式搜索法交替生成全局和局部路径,更符合无人机在实际飞行中的需要,能有效提高无人机的安全性能。
附图说明
图1为本发明方法的流程框图。
具体实施方式
下面结合附图及实施例对本发明进一步详细说明。
如图1所示,本发明涉及一种针对无人机计算与存储能力受限的双层路径规划方法。第一步,基于已有地图信息并考虑无人机自身动力学性能限制,利用鱼群算法生成初始参考航迹;第二步,利用机载传感器获取无人机及周围障碍物等环境信息,并利用三维碰撞锥技术判断障碍物是否对无人机造成威胁;第三步,根据第二步中的判断,若有威胁,利用基于马尔科夫过程的前向式搜索法生成局部避障路径,按照局部规划航迹进行飞行,若无威胁,无人机沿第一步中的参考航迹继续飞行;第四步,根据第三步中的避障路径进行避障,避障完成,无人机继续飞行,直到抵达参考航迹期望点。本发明具有收敛速度快、数据存储负担小、安全性高等优点,可用于无人机安全快速避障,还可推广到无人车、无人飞行器的自主避障。
具体实现步骤如下:
第一步,基于已有地图信息并考虑无人机自身动力学性能限制,利用鱼群算法生成初始参考航迹:
首先,建立用于表征无人机飞行过程的动力学模型、无人机飞行过程中所必须满足的动力学限制、静态障碍物和动态障碍物的空间存在范围模型。
建立用于表征无人机飞行过程的动力学模型,表示如下:
其中,(x,y,z)表示飞机机身质心位置在地面惯性坐标系中的空间坐标,(θ,ψ)分别表示俯仰角和偏航角,V代表飞机速度。
建立无人机飞行过程中所必须满足的动力学限制,包括无人机飞行速度范围,最小转弯半径,以及与半径相关联的限制条件,表示如下:
其中,(Vmin,Vmax)分别表示最小和最大飞行速度,(r,rmin)表示转弯半径与最小转弯半径,g和φmax表示常数重力加速度与最大滚转角。
无人机飞行过程中分别存在静态障碍物以及动态障碍物,这些障碍物的空间存在范围表示如下:
其中,(xobs,yobs,zobs)和(xobs(t),yobs(t),zobs(t))分别表示静态与移动障碍物中心位置坐标,(a,b,c,p,q,σ)用于表征静态障碍物尺寸大小与形状,ξ表示动态障碍物半径大小;
其次,根据表征无人机飞行过程的动力学模型、无人机飞行过程中所必须满足的动力学限制、静态障碍物和动态障碍物的空间存在范围模型,建立无人机安全飞行空域即无碰撞空间,并明确无人机起飞前获得的初始信息。
无人机飞行过程中需要规避静态障碍物以及动态障碍物,对安全飞行空域即无碰撞空间建模,表示如下:
其中,Cfree表示无碰撞空域,λ≥1是用于提升飞行安全的膨胀系数;
明确无人机起飞前获得的初始信息,包括环境信息:无人机起点(x0,y0,z0),目的地(xd,yd,zd),禁飞区,无人机自身动力学限制:rmin,Vmin。
最后,利用鱼群算法规划无人机从起点到达目的地的初始参考航迹,同时将无人机物理学限制考虑在内,得到一条满足航迹平滑、燃油经济、高安全的飞行轨迹(Xoptimal),该算法目标函数f(X)以最小值为最优,设置如下:
其中,f1(X)对应于无人机航迹平滑指标,(xi,yi,zi),(xi+1,yi+1,zi+1),(xi+2,yi+2,zi+2)表示参考轨迹上的三个离散点,αi表示三个相邻路径点夹角。
其中,f2(X)对应于无人机燃油经济指标。
其中,f3(X)对应于无人机安全指标,Ds表示设定的最小安全距离,β1表示无人机与障碍物的最小距离,β2>>0表示碰撞的惩罚。
f(X)=ρ1f1(X)+ρ2f2(X)+ρ3f3(X)
其中,0<ρ1<1,0<ρ2<1,和0<ρ3<1分别表示三个考虑因素所占的权重。
对无人机航迹平滑指标、燃油经济指标和安全指标进行加权组合,计算满足甲醛组合后的综合指标f(X)的最小值,当综合指标f(X)取得最小值时,得到最优的初始参考航迹Xoptimal。
第二步,利用机载传感器获取无人机及周围障碍物等环境信息,并利用三维碰撞锥技术判断障碍物是否对无人机造成威胁:
在飞行过程中,利用机载传感器,包括但不限于陀螺仪,加速度计,激光雷达,视觉系统,可以获得当前无人机自身的位置速度信息,以及无人机一定范围内环境的信息。其中有效检测环境范围,表示如下:
S={S|(x-x′)2+(y-y′)2+(z-z′)2≤R2}
其中,S和R分别表示检测范围及其半径;x、y、z分别表示无人机机身质心位置;x′、y′、z′分别表示无人机机身质心移动速度。
当检测的无人机周围出现未知障碍物时,根据无人机与障碍物的相对位置及速度信息,利用三维碰撞锥方法预测,按照初始规划航迹继续飞行,是否会出现碰撞。若否,则执行第四步;如果是,进入第三步;
构建三维碰撞锥,用于预测无人机是否会与检测到的障碍物发生碰撞。无人机附近检测到威胁,无人机与检测到的障碍物之间相对速度和位置以及速度夹角,表示如下:
其中,和PO表示具有威胁的障碍物的速度和位置坐标。根据无人机的安全距离d1,可以以无人机为质点构建一个无人机安全球形区域,同样在具有威胁的障碍物上也可以构建一个相对安全的球形区域。连接无人机和具有威胁的障碍物质心,从无人机质心到具有威胁的障碍物球形区域做切线可以构建一个三维碰撞锥。三维碰撞锥的半夹角表示如下:
其中,d表示无人机和具有威胁的障碍物间的直线距离。从而可以得到无人机和具有威胁的障碍物间无碰撞条件为:
α0>α
其中,α0表示从无人机质心到具有威胁的障碍物的球形区域的安全夹角,α表示三维碰撞锥的半夹角。
第三步,根据第二步中的判断,若有威胁,利用基于马尔科夫过程的前向式搜索法生成局部避障路径,按照局部规划航迹进行飞行,若无威胁,无人机沿第一步中的参考航迹继续飞行:
当α0≤α,则无人机进入局部路径规划模式,利用前向式搜索法规划一条新的避障路径。
将飞行空间以同样大小的立方体划分,每个立方体对应加上序号,得到一组状态集合S。无人机从当前状态,在飞行动作集合A中选择一个前进动作a,按照一定的概率分布到达下一个状态。当到达下一个状态时,给予无人机一个奖励值R。用表示在状态S执行动作a获得的奖励。
碰撞预测结果与奖励相联系,用于加速在线计算,当|α0|-α>0时,无人机与具有威胁的障碍物朝着距离加大的方向飞行,则赋予当前时刻采取动作at一个正的奖励值,其他动作奖励值为零,表示如下:
当|α0|-α≤0时,无人机与具有威胁的障碍物朝着距离减小的方向飞行且将导致碰撞,则赋予at相邻动作正的奖励值,其他动作奖励值为零,表示如下:
此外,为了缓解计算机存储负担,在获得每一步的决策结果后,初始化当前状态,避免将过多的状态引入局部计算中。根据这种基于马尔科夫过程的前向式搜索法生成局部避障路径,并时无人机按照局部规划航迹进行飞行。
第四步,根据第三步中的避障路径进行避障,避障完成,无人机继续飞行,直到抵达参考航迹期望点,完成针对无人机计算与存储能力受限的双层路径规划方法:
当未知障碍物规避完成后,返回初始规划路径;根据终止条件,判断是否到达目的地。若是,则任务完成。若否,则返回第三步。终止条件表示为:
其中,(xtar,ytar,ztar)表示目的地空间坐标,x(t)、y(t)、z(t)分别表示在时间t时的无人机机身质心位置。
位置障碍物规避完成后,返回全局参考航迹,继续按照参考航迹飞行,直至到达目的地。
测试地图为900m*700m*100m的三维空域,地图上随机设定了一系列圆柱状禁飞区,此外另有一架威胁飞行器在某时刻入侵到初始参考路径。以0.1s作为局部路径规划的采样时间。以1s作为一个间隔时间,无人机和威胁在各个离散时刻的位置证明的局部避障的成功。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (6)
1.一种针对无人机计算与存储能力受限的双层路径规划方法,其特征在于,包括以下步骤:
第一步,基于已有地图信息并考虑无人机自身动力学性能限制,利用鱼群算法生成初始参考航迹;
第二步,利用机载传感器获取无人机及环境信息,并利用三维碰撞锥技术判断障碍物是否对无人机造成威胁;
第三步,若判断障碍物对无人机造成威胁,则进入局部路径规划模式,利用基于马尔科夫过程的前向式搜索法生成局部避障路径,按照局部规划航迹进行飞行,进入第四步;若无威胁,无人机沿第一步中的初始参考航迹继续飞行;
第四步,避障完成后,无人机继续飞行,直到抵达参考航迹期望点,完成针对无人机计算与存储能力受限的双层路径规划。
2.根据权利要求1所述的一种针对无人机计算与存储能力受限的双层路径规划方法,其特征在于:所述第一步中,基于已有地图信息并考虑无人机自身动力学性能限制,利用鱼群算法生成初始参考航迹,具体步骤如下:
首先,建立用于表征无人机飞行过程的动力学模型、无人机飞行过程中所必须满足的动力学限制、静态障碍物和动态障碍物的空间存在范围模型,即建立用于表征无人机飞行过程的动力学模型如下:
其中,(x,y,z)表示飞机机身质心位置在地面惯性坐标系中的空间坐标,(θ,ψ)分别表示俯仰角和偏航角,V代表飞机速度;
建立无人机飞行过程中所必须满足的动力学限制,动力学限制包括无人机飞行速度范围、最小转弯半径及与半径相关联的限制条件,动力学限制表示如下:
其中,(Vmin,Vmax)分别表示最小和最大飞行速度,(r,rmin)表示转弯半径与最小转弯半径,g和φmax表示常数重力加速度与最大滚转角;
无人机飞行过程中分别存在静态障碍物以及动态障碍物,这些障碍物的空间存在范围表示如下:
其中,(xobs,yobs,zobs)和(xobs(t),yobs(t),zobs(t))分别表示静态与移动障碍物中心位置坐标,(a,b,c,p,q,σ)用于表征静态障碍物尺寸大小与形状,ξ表示动态障碍物半径大小;
其次,根据表征无人机飞行过程的动力学模型、无人机飞行过程中所必须满足的动力学限制、静态障碍物和动态障碍物的空间存在范围模型,建立无人机安全飞行空域即无碰撞空间,并明确无人机起飞前获得的初始信息;
无人机飞行过程中需要规避静态障碍物以及动态障碍物,对安全飞行空域即无碰撞空间建模,表示如下:
其中,Cfree表示无碰撞空域,λ≥1是用于提升飞行安全的膨胀系数;
明确无人机起飞前获得的初始信息,包括环境信息:无人机起点(x0,y0,z0),
目的地(xd,yd,zd),禁飞区,无人机自身动力学限制:rmin,Vmin;
最后,利用鱼群算法规划无人机从起点到达目的地的初始参考航迹,同时将无人机物理学限制考虑在内,得到一条满足航迹平滑、燃油经济、高安全的飞行轨迹(Xoptimal),该算法目标函数f(X)以最小值为最优,设置如下:
其中,f1(X)对应于无人机航迹平滑指标,(xi,yi,zi),(xi+1,yi+1,zi+1),(xi+2,yi+2,zi+2)表示参考轨迹上的三个离散点,αi表示三个相邻路径点夹角;
其中,f2(X)对应于无人机燃油经济指标;
其中,f3(X)对应于无人机安全指标,Ds表示设定的最小安全距离,β1表示无人机与障碍物的最小距离,β2>>0表示碰撞的惩罚;
f(X)=ρ1f1(X)+ρ2f2(X)+ρ3f3(X)
其中,0<ρ1<1,0<ρ2<1,和0<ρ3<1分别表示三个考虑因素所占的权重;
对无人机航迹平滑指标、燃油经济指标和安全指标进行加权组合,计算满足甲醛组合后的综合指标f(X)的最小值,当综合指标f(X)取得最小值时,得到最优的初始参考航迹Xoptimal。
3.根据权利要求1所述的一种针对无人机计算与存储能力受限的双层路径规划方法,其特征在于:所述第二步中,所述机载传感器包括陀螺仪,加速度计、激光雷达和视觉系统,所述机载传感器有效检测环境范围如下:
S={S|(x-x′)2+(y-y′)2+(z-z′)2≤R2}
其中,S和R分别表示检测范围及其半径;x、y、z分别表示无人机机身质心位置;x′、y′、z′分别表示无人机机身质心移动速度。
4.根据权利要求1所述的一种针对无人机计算与存储能力受限的双层路径规划方法,其特征在于:所述第二步中,三维碰撞锥技术实现如下:
构建三维碰撞锥:用于预测无人机是否会与检测到的障碍物发生碰撞,无人机与检测到的障碍物之间的相对速度、位置以及速度夹角,表示如下:
其中,和PO表示具有威胁的障碍物的速度和位置坐标,根据无人机的安全距离d1,以无人机为质点构建一个无人机安全球形区域,同样在具有威胁的障碍物上也构建一个相对安全的球形区域,连接无人机和具有威胁的障碍物质心,从无人机质心到具有威胁的障碍物的球形区域做切线构建一个三维碰撞锥,三维碰撞锥的半夹角表示如下:
其中,d表示无人机和具有威胁的障碍物间的直线距离,得到无人机和具有威胁的障碍物间无碰撞条件为:α0>α,其中,α0表示从无人机质心到具有威胁的障碍物的球形区域的安全夹角,α表示三维碰撞锥的半夹角。
5.根据权利要求1所述的一种针对无人机计算与存储能力受限的双层路径规划方法,其特征在于:所述第三步中,局部路径规划模式,利用基于马尔科夫过程的前向式搜索法生成局部避障路径,按照局部规划航迹进行飞行,具体过程如下:
将飞行空间以同样大小的立方体划分,每个立方体对应加上序号,得到一组状态集合S;无人机从当前状态,在飞行动作集合A中选择一个前进动作a,按照一定的概率分布到达下一个状态;当到达下一个状态时,给予无人机一个奖励值R。用表示在状态S执行动作a获得的奖励;
碰撞预测结果与奖励相联系,用于加速在线计算,当|α0|-α>0时,无人机与具有威胁的障碍物朝着距离加大的方向飞行,则赋予当前时刻采取动作at一个正的奖励值,其他动作奖励值为零,表示如下:
当|α0|-α≤0时,无人机与具有威胁的障碍物朝着距离减小的方向飞行且将导致碰撞,则赋予at相邻动作正的奖励值,其他动作奖励值为零,表示如下:
此外,为了缓解计算机存储负担,在获得每一步的决策结果后,初始化当前状态,避免将过多的状态引入局部计算中;根据这种基于马尔科夫过程的前向式搜索法生成局部避障路径,并时无人机按照局部规划航迹进行飞行。
6.根据权利要求1所述的一种针对无人机计算与存储能力受限的双层路径规划方法,其特征在于:所述第四步中,避障完成后,无人机继续飞行,直到抵达参考航迹期望点时,要根据终止条件判断是否到达目的地,即参考航迹期望点,终止条件表示为:
其中,(xtar,ytar,ztar)表示目的地空间坐标,x(t)、y(t)、z(t)分别表示在时间t时的无人机机身质心位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910795321.8A CN110456823B (zh) | 2019-08-27 | 2019-08-27 | 一种针对无人机计算与存储能力受限的双层路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910795321.8A CN110456823B (zh) | 2019-08-27 | 2019-08-27 | 一种针对无人机计算与存储能力受限的双层路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110456823A true CN110456823A (zh) | 2019-11-15 |
CN110456823B CN110456823B (zh) | 2020-09-29 |
Family
ID=68489297
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910795321.8A Active CN110456823B (zh) | 2019-08-27 | 2019-08-27 | 一种针对无人机计算与存储能力受限的双层路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110456823B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111177851A (zh) * | 2019-12-27 | 2020-05-19 | 北航(四川)西部国际创新港科技有限公司 | 一种无人机运行安全风险评估中对地风险的评估方法 |
CN112051850A (zh) * | 2020-09-08 | 2020-12-08 | 中国人民解放军海军航空大学 | 一种基于惯导与激光雷达测量的机器人切线避障方法 |
CN112965531A (zh) * | 2021-03-04 | 2021-06-15 | 中国矿业大学 | 一种用于煤矿采空区无人探测的微小型飞行器及其方法 |
CN113156984A (zh) * | 2021-03-01 | 2021-07-23 | 之江实验室 | 多旋翼无人机航迹规划方法、装置、介质及多旋翼无人机 |
CN113253761A (zh) * | 2021-06-08 | 2021-08-13 | 北京远度互联科技有限公司 | 实时路径规划方法、装置、可移动载具及存储介质 |
CN113282103A (zh) * | 2021-05-24 | 2021-08-20 | 河北科技大学 | 基于改进自适应调整阈值势场法的无人机冲突探测和解脱方法 |
CN113467504A (zh) * | 2021-07-26 | 2021-10-01 | 广东电网有限责任公司 | 一种飞行器飞行稳定控制方法、系统、设备及存储介质 |
CN113625762A (zh) * | 2021-08-30 | 2021-11-09 | 吉林大学 | 无人机避障方法及系统、无人机集群避障方法及系统 |
CN113759985A (zh) * | 2021-08-03 | 2021-12-07 | 华南理工大学 | 一种无人机飞行控制方法、系统、装置及存储介质 |
CN113865556A (zh) * | 2021-09-23 | 2021-12-31 | 长安大学 | 一种分体式全景智能探测机器人及方法 |
CN115033027A (zh) * | 2022-08-15 | 2022-09-09 | 中国民航大学 | 一种固定翼无人机动态避障预测管理方法 |
CN115576357A (zh) * | 2022-12-01 | 2023-01-06 | 浙江大有实业有限公司杭州科技发展分公司 | 一种无rtk信号场景下全自动无人机巡检智能路径规划方法 |
CN117234240A (zh) * | 2023-11-10 | 2023-12-15 | 西安天成益邦电子科技有限公司 | 无人机集群地面控制可视控制方法及系统 |
CN117346793A (zh) * | 2023-12-04 | 2024-01-05 | 中国人民解放军国防科技大学 | 基于pg算法的无人机路径规划方法、装置、设备和介质 |
CN117369479A (zh) * | 2023-12-04 | 2024-01-09 | 江苏莳光地理信息科技有限公司 | 一种基于倾斜摄影测量技术的无人机障碍预警方法及系统 |
CN117647997A (zh) * | 2024-01-29 | 2024-03-05 | 中国人民解放军战略支援部队航天工程大学 | 知识双向迁移的无人机协同航迹局部重规划的方法和系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101866384A (zh) * | 2010-06-18 | 2010-10-20 | 杭州电子科技大学 | 一种基于车辆路径规划的改进人工鱼群优化方法 |
CN103365299A (zh) * | 2013-08-02 | 2013-10-23 | 中国科学院自动化研究所 | 一种无人机的避障方法及其装置 |
US9354296B2 (en) * | 2014-05-20 | 2016-05-31 | Verizon Patent And Licensing Inc. | Dynamic selection of unmanned aerial vehicles |
CN106774380A (zh) * | 2016-11-14 | 2017-05-31 | 中国人民解放军海军航空工程学院 | 一种动态不确定环境下无人飞行器平面自主避障方法 |
CN106919181A (zh) * | 2016-10-20 | 2017-07-04 | 湖南大学 | 一种无人机避障方法 |
CN107300925A (zh) * | 2017-07-12 | 2017-10-27 | 西北工业大学 | 基于改进鱼群算法的四旋翼无人机姿控参数整定方法 |
CN107392388A (zh) * | 2017-07-31 | 2017-11-24 | 南昌航空大学 | 一种采用改进人工鱼群算法规划无人机三维航迹的方法 |
-
2019
- 2019-08-27 CN CN201910795321.8A patent/CN110456823B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101866384A (zh) * | 2010-06-18 | 2010-10-20 | 杭州电子科技大学 | 一种基于车辆路径规划的改进人工鱼群优化方法 |
CN103365299A (zh) * | 2013-08-02 | 2013-10-23 | 中国科学院自动化研究所 | 一种无人机的避障方法及其装置 |
US9354296B2 (en) * | 2014-05-20 | 2016-05-31 | Verizon Patent And Licensing Inc. | Dynamic selection of unmanned aerial vehicles |
CN106919181A (zh) * | 2016-10-20 | 2017-07-04 | 湖南大学 | 一种无人机避障方法 |
CN106774380A (zh) * | 2016-11-14 | 2017-05-31 | 中国人民解放军海军航空工程学院 | 一种动态不确定环境下无人飞行器平面自主避障方法 |
CN107300925A (zh) * | 2017-07-12 | 2017-10-27 | 西北工业大学 | 基于改进鱼群算法的四旋翼无人机姿控参数整定方法 |
CN107392388A (zh) * | 2017-07-31 | 2017-11-24 | 南昌航空大学 | 一种采用改进人工鱼群算法规划无人机三维航迹的方法 |
Non-Patent Citations (4)
Title |
---|
XIAOBIN ZHOU,ETC: "UAV Collision Avoidance Based on Varying Cells Strategy", 《IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS》 * |
YANG LIU,ETC: "Adaptive sensitivity decision based path planning algorithm for unmanned aerial vehicle with improved particle swarm optimization", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
喻俊松,王琪,徐蓉瑞: "基于改进人工鱼群算法的无人机路径规划", 《弹箭与制导学报》 * |
熊超,解武杰,董文瀚: "基于碰撞锥改进人工势场的无人机避障路径规划", 《计算机工程》 * |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111177851A (zh) * | 2019-12-27 | 2020-05-19 | 北航(四川)西部国际创新港科技有限公司 | 一种无人机运行安全风险评估中对地风险的评估方法 |
CN112051850A (zh) * | 2020-09-08 | 2020-12-08 | 中国人民解放军海军航空大学 | 一种基于惯导与激光雷达测量的机器人切线避障方法 |
CN113156984A (zh) * | 2021-03-01 | 2021-07-23 | 之江实验室 | 多旋翼无人机航迹规划方法、装置、介质及多旋翼无人机 |
CN113156984B (zh) * | 2021-03-01 | 2022-09-09 | 之江实验室 | 多旋翼无人机航迹规划方法、装置、介质及多旋翼无人机 |
CN112965531A (zh) * | 2021-03-04 | 2021-06-15 | 中国矿业大学 | 一种用于煤矿采空区无人探测的微小型飞行器及其方法 |
CN113282103A (zh) * | 2021-05-24 | 2021-08-20 | 河北科技大学 | 基于改进自适应调整阈值势场法的无人机冲突探测和解脱方法 |
CN113253761B (zh) * | 2021-06-08 | 2021-11-09 | 北京远度互联科技有限公司 | 实时路径规划方法、装置、可移动载具及存储介质 |
CN113253761A (zh) * | 2021-06-08 | 2021-08-13 | 北京远度互联科技有限公司 | 实时路径规划方法、装置、可移动载具及存储介质 |
CN113467504A (zh) * | 2021-07-26 | 2021-10-01 | 广东电网有限责任公司 | 一种飞行器飞行稳定控制方法、系统、设备及存储介质 |
CN113467504B (zh) * | 2021-07-26 | 2023-06-02 | 广东电网有限责任公司 | 一种飞行器飞行稳定控制方法、系统、设备及存储介质 |
CN113759985A (zh) * | 2021-08-03 | 2021-12-07 | 华南理工大学 | 一种无人机飞行控制方法、系统、装置及存储介质 |
CN113625762A (zh) * | 2021-08-30 | 2021-11-09 | 吉林大学 | 无人机避障方法及系统、无人机集群避障方法及系统 |
CN113625762B (zh) * | 2021-08-30 | 2023-07-25 | 吉林大学 | 无人机避障方法及系统、无人机集群避障方法及系统 |
CN113865556A (zh) * | 2021-09-23 | 2021-12-31 | 长安大学 | 一种分体式全景智能探测机器人及方法 |
CN113865556B (zh) * | 2021-09-23 | 2024-02-02 | 长安大学 | 一种分体式全景智能探测机器人及方法 |
CN115033027A (zh) * | 2022-08-15 | 2022-09-09 | 中国民航大学 | 一种固定翼无人机动态避障预测管理方法 |
CN115576357B (zh) * | 2022-12-01 | 2023-07-07 | 浙江大有实业有限公司杭州科技发展分公司 | 一种无rtk信号场景下全自动无人机巡检智能路径规划方法 |
CN115576357A (zh) * | 2022-12-01 | 2023-01-06 | 浙江大有实业有限公司杭州科技发展分公司 | 一种无rtk信号场景下全自动无人机巡检智能路径规划方法 |
CN117234240A (zh) * | 2023-11-10 | 2023-12-15 | 西安天成益邦电子科技有限公司 | 无人机集群地面控制可视控制方法及系统 |
CN117234240B (zh) * | 2023-11-10 | 2024-02-27 | 西安天成益邦电子科技有限公司 | 无人机集群地面控制可视控制方法及系统 |
CN117346793A (zh) * | 2023-12-04 | 2024-01-05 | 中国人民解放军国防科技大学 | 基于pg算法的无人机路径规划方法、装置、设备和介质 |
CN117369479A (zh) * | 2023-12-04 | 2024-01-09 | 江苏莳光地理信息科技有限公司 | 一种基于倾斜摄影测量技术的无人机障碍预警方法及系统 |
CN117369479B (zh) * | 2023-12-04 | 2024-02-13 | 江苏莳光地理信息科技有限公司 | 一种基于倾斜摄影测量技术的无人机障碍预警方法及系统 |
CN117346793B (zh) * | 2023-12-04 | 2024-02-13 | 中国人民解放军国防科技大学 | 基于植物生长算法的无人机路径规划方法、装置、设备和介质 |
CN117647997A (zh) * | 2024-01-29 | 2024-03-05 | 中国人民解放军战略支援部队航天工程大学 | 知识双向迁移的无人机协同航迹局部重规划的方法和系统 |
CN117647997B (zh) * | 2024-01-29 | 2024-04-16 | 中国人民解放军战略支援部队航天工程大学 | 知识双向迁移的无人机协同航迹局部重规划的方法和系统 |
Also Published As
Publication number | Publication date |
---|---|
CN110456823B (zh) | 2020-09-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110456823A (zh) | 一种针对无人机计算与存储能力受限的双层路径规划方法 | |
CN108731684B (zh) | 一种多无人机协同区域监视的航路规划方法 | |
CN113791634B (zh) | 一种基于多智能体强化学习的多机空战决策方法 | |
CN111897316B (zh) | 一种场景快变条件下的多飞行器自主决策方法 | |
CN108388270A (zh) | 面向安全域的集群无人机轨迹姿态协同控制方法 | |
CN108319291B (zh) | 一种基于安全边界分析的无人机认知防碰撞控制方法 | |
Tang et al. | Systematic review of collision-avoidance approaches for unmanned aerial vehicles | |
CN109191923A (zh) | 一种无人机飞行冲突解脱方法及解脱系统 | |
CN108549408A (zh) | 一种自动防撞地航迹规划方法及系统 | |
CN114330115B (zh) | 一种基于粒子群搜索的神经网络空战机动决策方法 | |
CN103713642A (zh) | 一种基于扰动流体动态系统的无人机三维航路规划方法 | |
Zsedrovits et al. | Onboard visual sense and avoid system for small aircraft | |
WO2019040179A1 (en) | LANDING CONTROL OF AERIAL ROBOTIC VEHICLE USING THREE DIMENSIONAL FIELD CARDS GENERATED BY ODOMETRY OF VISUAL INERTIA | |
CN113534838A (zh) | 一种基于人工势场法的改进无人机航迹规划方法 | |
CN114594788A (zh) | 一种未知环境下四旋翼无人飞行器航迹规划方法及系统 | |
CN111508282A (zh) | 低空无人机农田作业飞行障碍物冲突检测方法 | |
CN111142555B (zh) | 一种基于碰撞风险的机场无人机管控区域划设方法 | |
Choutri et al. | A fully autonomous search and rescue system using quadrotor UAV | |
CN110793522B (zh) | 一种基于蚁群算法的航迹规划方法 | |
CN114676743B (zh) | 基于隐马尔可夫模型的低慢小目标航迹威胁识别方法 | |
Tsintotas et al. | The MPU RX-4 project: Design, electronics, and software development of a geofence protection system for a fixed-wing vtol uav | |
Fan et al. | Path planning for a reconnaissance UAV in uncertain environment | |
Cobano et al. | Thermal detection and generation of collision-free trajectories for cooperative soaring UAVs | |
Liao et al. | UAV swarm formation reconfiguration control based on variable-stepsize MPC-APCMPIO algorithm | |
Shi et al. | A distributed conflict detection and resolution method for unmanned aircraft systems operation in integrated airspace |
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 |