网站logo设计教程,正规的投资公司融资流程,可以做手机网页的网站,自己做卖东西网站近年来#xff0c;无人机(unmanned aerial vehicle#xff0c;UAV)由于其灵活度高、机动性强、安全风险系数小、成本低等特点#xff0c;被广泛应用于搜索巡逻、侦察监视、抢险救灾、物流配送、电力巡检、农业灌溉等军用或民用任务。路径规划是无人机执行任务的关键#xf…
近年来无人机(unmanned aerial vehicleUAV)由于其灵活度高、机动性强、安全风险系数小、成本低等特点被广泛应用于搜索巡逻、侦察监视、抢险救灾、物流配送、电力巡检、农业灌溉等军用或民用任务。路径规划是无人机执行任务的关键也是自主无人机在工程应用上的主要挑战。
现有的无人机路径规划算法主要分为经典算法和元启发式算法经典算法包括A*算法、快速搜索随机数RRT等但这些算法在面对复杂环境时搜索效率较低收敛迟缓。而元启发式算法即在启发式算法基础上改进的一种智能优化算法路径优化问题是典型的NP-hard问题其常带有复杂约束一般的求解器很难找到精确解但PSO、GA、GWO等智能优化算法能够有效求解复杂的组合优化问题因而在无人机路径规划的研究中已经得到广泛的应用。
因此本文将元启发式算法应用于几个不同复杂程度的地形模型同时考虑到一些智能优化算法容易陷入局部最优解因此本文也引入作者的一些原创改进算法以进一步提升其全局搜索性能。
00 文章目录
1 UAV路径规划问题建模
2 智能优化算法、原创改进算法原理
3 代码目录
4 仿真实验
5 源码获取
01 UAV路径规划问题建模
在复杂的地形中无人机按照路径规划结果从起始点飞向目标点。在飞行过程中无人机可能面临地形障碍、火力威胁、雷达扫描区域等障碍物同时有燃料消耗最大爬升和最大转弯能力等约束为保证UAV的安全协调飞行路径规划算法需要得到连接起点和终点的最佳路径。
假设无人机保持预先给定的飞行速度。这样路径规划问题就被简化为一个静态的折线规划问题。考虑无人机的运行要求因此通过计算航程长度成本、飞行高度成本、威胁成本和平滑成本定义无人机路径规划的成本函数其数学表示如下 其中Xi是决策变量为n个航站点(x,y,z)的列表bk为各成本函数的权重Fk为第k个成本函数。下面具体介绍一下这4个成本函数。本篇中的成本函数的参考文献为[1]。
1.1 航程长度成本
无人机的飞行路线的长度应尽可能短以保存无人机的燃料消耗其通过多个段的总和来计算。将两个节点之间的欧几里得距离作为每个段的长度然后计算特定路径P的路径长度成本如下 1.2 威胁成本
除了路径长度最优之外路径规划中的路径还必须要确保无人机的安全运行可能会遇到被称为威胁区域的禁飞区例如雷达探测、防空装备攻击或天气威胁等。考虑到威胁建模的复杂性和获取真实数据的困难性本文对威胁环境进行了抽象化处理将威胁区域抽象为一个半径为定值的圆柱体威胁区域的作用半径等同于圆柱体的半径设置威胁区域的目的是为了满足无人机的飞行环境让无人机成功避开威胁区域以完成飞行任务。其图像如下 设M为所有存在威胁的障碍物集合障碍物模型为圆柱体其投影的圆心为CmRm为障碍物的半径D为无人机的直径相邻两个路径节点与原点的垂直距离为dmS表示障碍物的危险区域该值取决于无人机的定位精度与飞行环境。如果无人机处于静态环境中且 GPS 信号良好那么 S 的值可能是几十米如果环境中存在移动的物体或GPS信号差那么S的值将超过百米。对于一个路径其威胁成本计算式为
当无人机在危险区域以外的地方飞行时不存在碰撞的风险其威胁为零而当无人机经过危险区域时dm越小威胁越大当无人机途经碰撞区域时无人机会碰撞坠毁此时设定该路径的威胁赋值为无穷。
1.3高度成本
UAV飞行高度通常由最小高度hmin和最大高度hmax约束例如对于测量和搜索时需要由相机以特定分辨率和视角收集视觉数据。如图所示
图源文献[1]
则高度成本计算如下 可以看出高度成本将保持平均高度并惩罚超出范围的值。
1.4 平滑成本
无人机的飞行角度控制参数主要包括水平转向角和垂直俯仰角这两个参数变量必须满足无人机的实际角度约束否则轨迹规划模型无法生成可行的飞行路径。如图所示
图源文献[1]
水平转向角φij是投影在水平面Oxy上的两个连续路径段之间的角度水平转向角计算为 垂直俯仰角ψij是投影在竖轴上的两个连续路径段之间的角度则垂直俯仰角计算为
则平滑成本计算如下
式中a1和a2分别为水平转向角和垂直俯仰角的惩罚系数。
1.5 环境建模
本文使用真实的数字高程模型DEM地图进行作为无人机路径规划问题中的环境。选择了一个澳大利亚圣诞岛的DEM以及另一个具有不同地形结构的数据地图。对其增添不同的威胁物以对不同复杂度的地形进行模拟最终共生成4个地形以供路径规划地形环境如下 1.6 解的编码
文献[1]中创新从地方之一就是他用的是球形矢量坐标而不是我们通常的直角坐标球形坐标可以表示如下
他用径向距离r极角θ方位角φ来表示位置若三维直角坐标是(x,y,z)那么球坐标就是(r,θ,φ)。这种编码方式的优点在于若将优化算法中的解的种群按r,θ,φ编码那么其可以描述出某个点到下一个点的运动轨迹并且也可以完美使其运动轨迹满足于平滑成本中的转向角和俯仰角的要求与随机产生n个直角坐标相比这种方式产生的解质量更高、更容易产生可行解当固定速度飞行时可以固定其r。
举一个容易理解的例子 若采用直角坐标系进行初始化种群则是下面的紫色线其xyz都是随机产生因此下一个节点虽然可以在空间的任何位置但节点间没有关联容易产生不满足于约束的解而球形坐标能够基于上一个点进行运动获得可行解的几率更高。
球形坐标与直角坐标的转换关系如下 其中ρ就是径向距离rψ就是极角θφ就是方位角φ
02智能优化算法、原创改进算法原理
本文使用了灰狼、鲸鱼、粒子群等共6种智能优化算法并引入了作者的原创改进算法
03 代码目录 代码仅有MATLAB版本包含乱码解决方案若运行出现问题可联系我。
部分代码如下 可以看到作者已基本整理的和函数测试的代码格式一致非常方便大家进行修改。
04 仿真实验
其中绘图的结果和我在程序中设定的各成本函数的权值有关 另外作者也引入了在往期文章中的原创改进算法部分结果如下 05 源码获取
1.作者的此版本的代码基础即是文献[1]中的开源代码这份代码对UAV的编程学习有很大的帮助
大家可以 搜索该文献获取其代码 或 GZHKAU的云实验台后台回复UAV2 获取其 github地址。
2.本文代码
GZHKAU的云实验台后台回复UAVB
3.包含作者原创改进算法的代码
如改进的灰狼、鲸鱼和哈里斯鹰但由于算法的随机性其结果并不能每次都是算法中的最优因此若想要该部分算法的可以和作者了解一下再决定获取方式
引入MSGWO的UAV —— GZHKAU的云实验台后台回复
UAVGWO
引入AAMCWOA的UAV —— GZHKAU的云实验台后台回复
UAVWOA
引入SDMQHHO的UAV —— GZHKAU的云实验台后台回复
UAVHHO
参考文献
[1]PHUNG M D, HA Q P. Safety-enhanced UAV path planning with spherical vector-based particle swarm optimization [J]. Ap⁃ plied Soft Computing, 2021, 107: 107376.
另如果有伙伴有待解决的优化问题各种领域都可可以发我我会选择性的更新利用优化算法解决这些问题的文章。
如果这篇文章对你有帮助或启发可以点击右下角的赞/再看 (ง •̀_•́)ง(不点也行)若有定制需求可私信作者。
