一种具有端点方向和时间约束的无人机航迹规划方法技术

本发明专利技术提出了一种具有端点方向和时间约束的无人机航迹规划方法。其步骤包括：构建环境，划分空间；输入起点和终点的坐标位置及其对应朝向角并计算出新的起点和终点；改进稀疏A*算法，在代价函数中增加加速度代价，以在规定时间到达终点为准调整节点加速度代价值，并用该算法进行航迹规划；将原始起点和终点加入航迹；双向搜索，选出较优航迹输出，完成航迹规划。本发明专利技术基于改进稀疏A*算法，能够解决无人机在复杂约束下的航迹规划问题，其中复杂约束包括以预定角度出发和到达的端点方向约束、时间约束、无人机运动学约束以及障碍威胁规避约束。

A path planning method for UAV with terminal direction and time constraints

【技术实现步骤摘要】
一种具有端点方向和时间约束的无人机航迹规划方法
本专利技术涉及一种具有端点方向和时间约束的无人机航迹规划方法，属于航迹规划领域。
技术介绍
无人机航迹规划，指的是无人机在满足性能、地形环境以及任务约束的条件下，寻找到从起始点到目标点的可行航迹。由于战场敌对环境的复杂，以及无人机自身性能存在约束，为无人机规划航迹能够更好地适应环境，避开威胁，提高无人机的安全性，减少航程，降低油耗，减少机动操作，保证预定任务的完成。目前的路径规划用到的启发式算法有A*算法、遗传算法、粒子群算法、蚁群算法等，其中A*算法更为简单高效。传统的A*算法是在规划环境网格化的基础上根据设定的代价函数寻找最小代价的路径，稀疏A*算法是在传统A*算法的基础上，在扩展节点时，通过考察各种约束条件，有效地缩减搜索空间和缩短搜索时间，能够快速收敛得到所求路径，稀疏A*算法比传统A*算法减少了扩展节点的数量，在时间和空间上都有很大的改善，但在启发函数的定义上和路径点的处理上仍需改进。目前已有的解决具有端点方向约束的方法为在起点/终点附近设置高代价区域，但该方法并不能保证无人机一定以规定角度飞入或者飞出，只能控制在一定范围内，且会造成可行解空间的损失；目前已有的解决具有时间约束的方法为通过调整速度来满足时间维度的方法，但并未考虑速度的调整仍然需要时间，过于理想化，不符合实际情况，本专利技术可以解决上述问题。稀疏A*算法在面临比较复杂的环境时，由于每一步只进行一次扩展，对于环境的感知能力是有限的，比如近似“凹”字形区域，很有可能会出现绕径，或者不是全局最优的情况，针对该情况，本专利技术可以解决此类问题。
技术实现思路
本专利技术的目的在于解决具有端点方向和时间约束的无人机航迹规划问题，使规划出的航迹更符合实际情况且较优。本专利技术的技术方案如下：一种具有端点方向和时间约束的无人机航迹规划方法，其特征在于，包括以下步骤：步骤一，构建环境，划分空间；步骤二，将要规划航迹的无人机的起点和终点的坐标位置和对应朝向角输入，以最小步长为距离，沿起点朝向角方向计算出新的起点，沿终点朝向角反方向计算出新的终点；步骤三，利用改进稀疏A*算法进行航迹求解，在该算法的代价函数中增加加速度代价，以在规定时间到达终点为准调整加速度代价值，并求解得到航迹点集合；步骤四，将原始起点和终点加入航迹点集合，得到一条规划航迹；步骤五，将第二步中起点和终点的坐标位置和对应朝向角对调后输入，重复第二至第四步，得到另一条规划航迹；步骤六，对比所得两条航迹，选其中总航迹代价较小的一条作为最终航迹输出。上述步骤三中，改进稀疏A*算法中的扩展节点时的约束条件包括以下几点：地形约束、最小步长约束、最大航程约束、最大飞行高度约束、最小离地高度约束、雷达威胁约束以及时间约束。其中：最小步长约束:要求无人机航迹段长度不小于某一个值，该值是无人机在改变姿态时必须直飞的一个距离，也是每次扩展节点的最小距离；最大航程约束：由于无人机只能携带一定数量的燃油，因此无人机应该有一个最大航程距离的约束；最大飞行高度约束：受制于无人机自身性能，需要无人机在不超过某一个高度的范围内飞行，以确保一定的安全性，应该确定最大飞行高度的约束；最小离地高度约束：飞行高度过低的话，无人机容易与地面发生碰撞，因此确定最小离地高度约束，同样也是确保安全性；雷达威胁约束：在敌对环境中存在着预警雷达，首先计算当前点到威胁中心的欧式距离，并将这个距离与雷达的最小半径和最大半径进行比较，小于最小半径的范围属于禁飞区，无人机是不能穿过的，否则被发现则此次任务失败，大于最大半径的范围是雷达检测不到的，属于安全区，而在两个半径之间的范围，雷达有一定的概率探测到无人机，这个概率与无人机距离威胁中心的远近有关，因此设定雷达威胁约束，保障无人机的安全；时间约束：无人机在规定的时间范围到达目标点，以满足对时间维度有要求的飞行任务。上述步骤三中，改进稀疏A*算法中的节点的代价函数为：，其中，为初始节点到该点的实际代价，为该点到目标节点的估计代价，为该点的加速度代价，为该点的雷达的威胁代价，并针对各项参数的单位以及数量级上的差异进行归一化的处理，为对应的权重系数。上述步骤三中，改进稀疏A*算法中的节点的加速度值的计算方法：设定当前点作匀变速直线运动到扩展点后，再匀速运动到目标点，运动总时间为预计到达时间，假设当前点的速度为,到飞行当前点的所花时间为,当前点到扩展点的距离为、所花时间为，扩展点的加速度为，扩展点到目标点的估计距离为、所花时间为，预计到达时间为，则根据求得扩展点的加速度，取其绝对值。本专利技术的有益效果：1.本专利技术提供的一种具有端点方向和时间约束的无人机航迹规划方法，以起点和终点的坐标位置、朝向角和最小步长计算出新的起点和终点，满足无人机的端点方向的精确约束；2.本专利技术提供的一种具有端点方向和时间约束的无人机航迹规划方法，提出改进稀疏A*算法，在代价函数的设计上，考虑到在实际情况中调整速度是需要时间的，增加了加速度代价，并以在规定时间到达终点为准调整加速度代价值，满足时间维度约束，使无人机在预定时间范围到达；3.本专利技术提供的一种具有端点方向和时间约束的无人机航迹规划方法，采用双向搜索的方法，能选出较优路径，改善A*算法存在的绕径问题。附图说明图1为本实施例的一种具有端点方向和时间约束的无人机航迹规划方法流程图；图2为本实施例的一种具有端点方向和时间约束的无人机航迹规划方法中改进稀疏A*算法流程图；图3为本实施例的稀疏A*算法实验结果截图；图4为本实施例的一种具有端点方向和时间约束的无人机航迹规划方法实验结果截图；图5为本实施例的一种具有端点方向和时间约束的无人机航迹规划方法中双向搜索实验结果对比图。具体实施方式为了使本专利技术实施例的目的、技术方案、优点更加清晰、明确，下面结合附图和实施案例，对本专利技术做进一步详细说明。本专利技术提出了一种具有端点方向和时间约束的无人机航迹规划方法，其流程图如图1所示，具体步骤如下：（1）构建环境，划分空间：加载.mat地形文件，该地形文件存储的是地形的三维坐标点，X、Y、Z轴方向的最大坐标值、、，以及雷达的数量、坐标、最小半径和最大半径，并生成需要的地形曲面图，之后将空间按照无人机飞行的最小步长划分为规则的网格单元，网格单元的各顶点为空间中的节点，方格的边长为最小步长，地形和雷达的边缘以及内部的点为不可到达的节点，地形和雷达外部的点为可到达的节点，不可到达的节点标记为-1，可到达的节点标记为2，所有标记按坐标存入矩阵MAP中，因此MAP矩阵为存储范围内所有点的标记的三维矩阵。（2）输入起点坐标位置以及对应的转弯角和俯仰角，输入终点的坐标位置以及对应的转弯角和本文档来自技高网...

【技术保护点】
1.一种具有端点方向和时间约束的无人机航迹规划方法，其特征在于，包括如下步骤：/n步骤一，构建环境，划分空间；/n步骤二，输入将要规划航迹的无人机的起点和终点的坐标位置和对应朝向角，以最小步长为距离，沿起点朝向角方向计算出新的起点，沿终点朝向角反方向计算出新的终点；/n步骤三，利用改进稀疏A*算法进行航迹求解，在该算法中的代价函数中增加加速度代价，以在规定时间到达终点为准调整加速度代价值，并求解得到航迹点集合；/n步骤四，将原始起点和终点加入航迹点集合，得到一条规划航迹；/n步骤五，将步骤二中起点和终点的坐标位置和对应朝向角对调后输入，重复步骤二至步骤四，得到另一条规划航迹；/n步骤六，对比所得两条航迹，选其中总航迹代价值较小的一条作为最终航迹输出。/n

【技术特征摘要】
1.一种具有端点方向和时间约束的无人机航迹规划方法，其特征在于，包括如下步骤：
步骤一，构建环境，划分空间；
步骤二，输入将要规划航迹的无人机的起点和终点的坐标位置和对应朝向角，以最小步长为距离，沿起点朝向角方向计算出新的起点，沿终点朝向角反方向计算出新的终点；
步骤三，利用改进稀疏A*算法进行航迹求解，在该算法中的代价...

【专利技术属性】
技术研发人员：李辉，俞瑞，黄操，陈希亮，王壮，
申请(专利权)人：四川大学，
类型：发明
国别省市：四川;51