一、无人机三维航迹规划

三维航迹规划是无人机在执行任务过程中的非常关键的环节，三维航迹规划的主要目的是在满足任务需求和自主飞行约束的基础上，计算出发点和目标点之间的最佳航路。

1.1路径最短约束

无人机航迹规划的首要目标是寻找起飞点和目标点之间最短路程的飞行路径方案。一般地，记无人机的飞行路径点为Wij=(xij,yij,zij)W_{i j}=\left(x_{i j}, y_{i j}, z_{i j}\right)Wij=(xij,yij,zij)即在第 iii 条飞行路径中第 jjj个路径点的无人机三维空间位置，则整条飞行路径 XiX_{i}Xi 可表示为包含 nnn 个路径点的三维数组。将 2 个路径点之间的欧氏距离记作路径段∥WijWi,j+1→∥\left\|\overrightarrow{W_{i j} W_{i, j+1}}\right\|WijWi,j+1，则与无人机飞行路径相关的成本函数 F1F_{1}F1 为:
F1(Xi)=∑j=1n−1∥WijWi,j+1→∥F_{1}\left(X_{i}\right)=\sum_{j=1}^{n-1}\left\|\overrightarrow{W_{i j} W_{i, j+1}}\right\|F1(Xi)=j=1∑n−1WijWi,j+1

1.2威胁最小约束

无人机通过躲避障碍物来确保安全作业航迹。设定障碍物威胁区为圆柱体形式，其投影如下图所示，记圆柱体中心坐标为 CkC_{k}Ck，半径为 RkR_{k}Rk，外围为碰撞威胁区 DDD，则无人机的避障威胁成本与其路径段∥WijWi,j+1→∥\left\|\overrightarrow{W_{i j} W_{i, j+1}}\right\|WijWi,j+1和障碍物中心 CkC_{k}Ck的距离dkd_{k}dk 成反比。

将飞行环境下的障碍物威胁区集合记作KKK，障碍物威胁成本惩罚系数记作γcγ_{c}γc ，则与无人机避障威胁相关的成本函数 F2F_{2}F2为:
F2(Xi)=∑j=1n−1∑k=1KTk(WijWi,j+1→)F_{2}\left(X_{i}\right)=\sum_{j=1}^{n-1} \sum_{k=1}^{K} T_{k}\left(\overrightarrow{W_{i j} W_{i, j+1}}\right)F2(Xi)=j=1∑n−1k=1∑KTk(WijWi,j+1)
其中：
Tk(WijWi,j+1→)={0(dk>D+Rk)γc((D+Rk)−dk)(Rk<dk<D+Rk)∞(dk<Rk)T_{k}\left(\overrightarrow{W_{i j} W_{i, j+1}}\right)=\left\{\begin{array}{ll} 0 & \left(d_{k}>D+R_{k}\right) \\ \gamma_{c}\left(\left(D+R_{k}\right)-d_{k}\right) & \left(R_{k}<d_{k}<D+R_{k}\right) \\ \infty & \left(d_{k}<R_{k}\right) \end{array}\right.Tk(WijWi,j+1)=⎩⎨⎧0γc((D+Rk)−dk)∞(dk>D+Rk)(Rk<dk<D+Rk)(dk<Rk)

1.3飞行高度约束

无人机的飞行高度通常受到最小高度 hminh_{min}hmin 和最大高度hmaxh_{max}hmax 的约束限制，如下图所示，其中TijT_{ij}Tij 为地形的高度，ZijZ_{ij}Zij为无人机相对于海平面的高度。

将无人机在路径点 WijW_{ij}Wij处距离基准地形地面的高度记作 hijh_{ij}hij，即 ZijZ_{ij}Zij和 TijT_{ij}Tij 的差，则与无人机当前路径点 WijW_{ij}Wij相关的成本函数 HijH_{ij}Hij 为:
Hij={γh(hij−hmax⁡)(hij>hmax⁡)0(hmin⁡<hij<hmax⁡)γh(hmin⁡−hij)(0<hij<hmin⁡)∞(hij<0)H_{i j}=\left\{\begin{array}{ll} \gamma_{h}\left(h_{i j}-h_{\max }\right) & \left(h_{i j}>h_{\max }\right) \\ 0 & \left(h_{\min }<h_{i j}<h_{\max }\right) \\ \gamma_{h}\left(h_{\min }-h_{i j}\right) & \left(0<h_{i j}<h_{\min }\right) \\ \infty & \left(h_{i j}<0\right) \end{array}\right. Hij=⎩⎨⎧γh(hij−hmax)0γh(hmin−hij)∞(hij>hmax)(hmin<hij<hmax)(0<hij<hmin)(hij<0)
同时，将无人机飞行高度超出约束限制条件的惩罚系数记作 γhγ_{h}γh，则与无人机飞行路径相关的成本函数 F3F_{3}F3为:
F3(Xi)=∑j=1nHijF_{3}\left(X_{i}\right)=\sum_{j=1}^{n} H_{i j}F3(Xi)=j=1∑nHij

1.4飞行转角约束

无人机的飞行转角控制参数主要包括水平转弯角和竖直俯仰角，这 2 个参数变量必须符合无人机的实际转角约束限制，否则航迹规划模型无法生成具有可行性的飞行路径。如下图所示，∥WijWi,j+1→∥\left\|\overrightarrow{W_{i j} W_{i, j+1}}\right\|WijWi,j+1和∥Wij+1Wi,j+2→∥\left\|\overrightarrow{W_{i j+1} W_{i, j+2}}\right\|Wij+1Wi,j+2表示无人机飞行路径中的 2 个连续路径段，Wij′Wi,j+1′→\overrightarrow{W_{i j}^{\prime} W_{i, j+1}^{\prime}}Wij′Wi,j+1′和Wij+1′Wi,j+2′→\overrightarrow{W_{i j+1}^{\prime} W_{i, j+2}^{\prime}}Wij+1′Wi,j+2′是其在xoy 平面的投影。

记

单目标应用：蜣螂优化算法求解无人机三维航迹规划，含四种对比算法（提供Matlab代码）相关推荐

单目标应用：蜣螂优化算法DBO与麻雀搜索算法SSA求解无人机三维航迹规划（提供Matlab代码）
一.无人机三维航迹规划三维航迹规划是无人机在执行任务过程中的非常关键的环节,三维航迹规划的主要目的是在满足任务需求和自主飞行约束的基础上,计算出发点和目标点之间的最佳航路. 1.1路径最短约束无人 ...
【无人机三维路径规划】基于蚁群算法实现无人机三维路径规划含Matlab代码
⛄ 内容介绍随着无人机可执行任务的多样化,航迹规划成为其顺利完成任务的基本前提.针对该问题,提出了基于蚁群算法的无人机航迹规划方法.运用等效地形模拟方法,将作战区域中的敌方威胁.地形障碍等效为山峰, ...
基于人工鱼群算法实现无人机三维路径规划含Matlab代码
✅作者简介:热爱科研的Matlab仿真开发者,修心和技术同步精进,matlab项目合作可私信.
【SSA三维路径规划】基于matlab麻雀算法无人机三维航迹规划【含Matlab源码 301期】
⛄一.麻雀算法求解无人机三维路径规划简介 1 引言随着无人机(Unmanned Aerial Vehicle,UAV)技术的不断发展,国内外学者对于无人机作战应用的研究日益增多.无人机航迹规划是任务 ...
【WOA三维路径规划】基于matlab灰狼算法无人机三维航迹规划【含Matlab源码 2445期】
⛄一.灰狼优化算法的无人机三维航迹规划 1 无人机航迹规划建模 1.1 地形模型首先, 本研究须对三维地理环境 (规划空间) 进行离散化处理.通过对规划空间进行立方体网格划分, 将空间划分为大小相等 ...
【WOA三维路径规划】灰狼算法无人机三维航迹规划【含Matlab源码 2445期】
⛄一.灰狼优化算法的无人机三维航迹规划 1 无人机航迹规划建模 1.1 地形模型首先, 本研究须对三维地理环境 (规划空间) 进行离散化处理.通过对规划空间进行立方体网格划分, 将空间划分为大小相等 ...
【PSO三维路径规划】基于matlab粒子群算法融合鸡群算法多无人机三维路径规划【含Matlab源码 1792期】
一.无人机简介无人机的航迹规划是指在综合考虑无人机飞行油耗.威胁.飞行区域以及自身物理条件限制等因素的前提下, 为飞行器在飞行区域内规划出从初始点到目标点最优或者满意的飞行航迹, 其本质是一个多约束 ...
【ABC三维路径规划】基于matlab人工蜂群算法多无人机三维路径规划【含Matlab源码 170期】
一.无人机简介 0 引言随着现代技术的发展,飞行器种类不断变多,应用也日趋专一化.完善化,如专门用作植保的大疆PS-X625无人机,用作街景拍摄与监控巡察的宝鸡行翼航空科技的X8无人机,以及用作水下 ...
【PSO三维路径规划】粒子群算法融合鸡群算法多无人机三维路径规划【含Matlab源码 1792期】
⛄一.无人机简介无人机的航迹规划是指在综合考虑无人机飞行油耗.威胁.飞行区域以及自身物理条件限制等因素的前提下, 为飞行器在飞行区域内规划出从初始点到目标点最优或者满意的飞行航迹, 其本质是一个多约 ...

单目标应用：蜣螂优化算法求解无人机三维航迹规划，含四种对比算法（提供Matlab代码）