一种基于A*算法的同区域多条无碰撞航线规划方法技术

本发明专利技术涉及一种基于A*算法的同区域多条无碰撞航线规划方法，利用A*算法进行由起飞点飞往任务区进入点的飞行航线搜索，合理的规划网格范围及所述航点优化条件，保证了规划出的无人机飞行航路的可用性，减少无人机的转弯次数，平滑了航线，并能保证无人机始终处于规划的飞行区域内。

【技术实现步骤摘要】
一种基于A*算法的同区域多条无碰撞航线规划方法
本专利技术涉及无人机航线规划领域，更具体地说，是指一种基于A*算法的同区域多条无碰撞航线规划方法。
技术介绍
无人机在执行任务前，均需要在地面进行航线的装订，航线一般是采用多个航点组成一个航点系列，再将航点之间利用线段连接而形成，无人机依照这些航点的地理坐标信息进行飞行，从而引导无人机沿预定航线飞至预定区域。当同一飞行区域内包含若干小的任务区域，并需要对应数量的无人机飞往指定任务区域时，在进行任务规划时则应充分考虑各无人机的出航路线以及禁飞区影响，常规的规划方法是采用人工规划的方法，考虑无人机航线之间的最小安全距离以及禁飞区，为每一架无人机进行航线规划，费时费力，并且不能保证获得最优的出航航线。另一种方法是采用启发式搜索算法来实现航线规划。其中，A*算法是一种经典的启发搜索算法，是一种静态路网中求解最短路径最有效的直接搜索方法，虽然该方法可以得到最短路径的航线，但该方法得到的航线不够平滑，拐点过多，不利于无人机跟踪航线，并且该方法适用于单条航线规划，对于多条航线规划则无法使用。
技术实现思路
要解决的技术问题为了避免现有技术的不足之处，本专利技术提出一种基于A*算法的同区域多条无碰撞航线规划方法，实现在同一飞行区域下多架无人机多条航线的自动规划，在提高航线平滑度的同时保证各无人机沿设定航线飞行过程中不会发生碰撞。技术方案一种基于A*算法的同区域多条无碰撞航线规划方法，其特征在于步骤如下：步骤1：获取飞行空域、禁飞区及任务目标区，飞行空域、禁飞区及任务目标区由封闭凸多边形进行定义，任务目标区必须被飞行空域完全包含，飞行空域只能为一个，禁飞区及任务目标区可以为一个或多个；根据给定的飞行空域确定规划区域范围，规划区域由多个边长为KD的正方形组成，KD为给定的常数，取值为两架无人机之间的允许最小间隔；规划区域的范围为飞行空域的最小外接矩形区域；步骤2：获取规划起点Si及终点Ei，其中i＝1,2,...,n，n为任务区域数量，Si为无人机起飞点，Ei为每个任务目标区的进入点，起点、终点与任务目标区一一对应，将规划区域内每个最小正方形网格作为一个节点，所有节点信息均初始化为能通过，再分别计算步骤1中获取的飞行空域、禁飞区及任务目标区所有边界穿越的节点，并将对应的节点信息设置为不能通过，最后计算起点及终点所在节点，并设置搜索起点及搜索终点，从而完成搜索地图初始化；步骤3：利用A*算法进行由起飞点S1飞往任务区1进入点E1的飞行航线搜索，若路径可达，则执行步骤4；若路径不可达，则需重新调整E1的位置，更新E1节点信息，再执行步骤3；使用A*算法搜索航线的过程中设定的条件如下：(1)可以进行扩展的节点限定为当前节点的上、右、下和左四个节点；(2)启发函数采用曼哈顿距离函数；步骤4：将搜索出的路径中每个节点信息设置为不能通过，其中不包括起点，并提取搜索出的路径中每个节点的中心坐标值(Bi,Li)作为一个航路点组成规划的初始航线，其中Bi、Li为第i个节点中心对应的纬度值和经度值；步骤5：设定初始航线中的第一点所在区域为A，其中心点大地坐标为(XA,YA)，其后的点所在区域依次为B、C、D，各区域中心点大地坐标分别为(XB,YB)、(XC,YC)和(XD,YD)，航线前进方向为A→B→C→D，判断该A至D航段是否属于下述条件之一：(1)XA＝XB且XC＝XD且YB＝YC情况下，XB-XC的绝对值等于KD；(2)YA＝YB且YC＝YD且XB＝XC情况下，YB-YC的绝对值等于KD；若符合以上条件其中任意一个，则删除设定的B、C两区域所对应的航路点，再将当前的D区域设为A，其后的点再依次设为B、C、D；若不符合任何一个所示形状，则将当前的B区域设为A，其后的区域再依次设为B、C、D；步骤6：重复步骤5的判断过程，直至设定的D区域为航线终点所在区域时停止判断，并将最终剩余的航路点作为最终航线进行输出；步骤7：按照步骤3～6所示方法依次对由起点Si飞往剩余任务区进入点Ei的飞行航线进行规划，其中i＝1,2,...,n，最终完成整个区域多条航线的规划。有益效果本专利技术提出的一种基于A*算法的同区域多条无碰撞航线规划方法，具有以下3点优点：1、本专利技术提出的航线规划方法，能在保证无人机飞行航程最优的前提下，自动避开禁飞区及其他无人机的飞行航道，保证多条航线无碰撞，并且不会穿越其他任务区域。2、通过合理的规划网格范围及所述航点优化条件，保证了规划出的无人机飞行航路的可用性，减少无人机的转弯次数，平滑了航线，并能保证无人机始终处于规划的飞行区域内。3、通过将已规划航线所穿越的区域属性进行重新定义，使得A*算法可以迭代使用，适用于多条航线的规划。附图说明图1飞行空域、任务区及禁飞区布局示意图图2规划区域构建示意图图3可优化航段形状具体实施方式现结合实施例、附图对本专利技术作进一步描述：本专利技术所涉方法步骤如下：步骤1：获取飞行空域、禁飞区及任务目标区，飞行空域、禁飞区及任务目标区由封闭凸多边形进行定义，任务目标区必须被飞行空域完全包含，飞行空域只能为一个，禁飞区及任务目标区可以为一个或多个。区域划分示意图如附图1所示。根据给定的飞行空域确定规划区域范围，规划区域由多个边长为KD的正方形组成，KD为给定的常数，取值为两架无人机之间的允许最小间隔。规划区域的范围为飞行空域的最小外接矩形区域，划分示意图如附图2所示。步骤2：获取规划起点Si及终点Ei，其中i＝(1,2,...,n)，n为任务区域数量，Si为无人机起飞点，Ei为每个任务目标区的进入点，起点、终点与任务目标区一一对应，将规划区域内每个最小正方形网格作为一个节点，所有节点信息均初始化为能通过，再分别计算步骤1中获取的飞行空域、禁飞区及任务目标区所有边界穿越的节点，并将对应的节点信息设置为不能通过，最后计算起点及终点所在节点，并设置搜索起点及搜索终点，从而完成搜索地图初始化。步骤3：利用A*算法进行由起飞点S1飞往任务区1进入点E1的飞行航线搜索，若路径可达，则执行步骤4；若路径不可达，则需重新调整E1的位置，更新E1节点信息，再执行步骤3。使用A*算法搜索航线的过程中设定的条件如下：(3)可以进行扩展的节点限定为当前节点的上、右、下和左四个节点；(4)启发函数采用曼哈顿距离函数；步骤4：将搜索出的路径(不包括起点)中每个节点信息设置为不能通过，并提取搜索出的路径中每个节点的中心坐标值(Bi,Li)作为一个航路点组成规划的初始航线，其中Bi、Li为第i个节点中心对应的纬度值和经度值。步骤5：设定初始航线中的第一点所在区域为A，其中心点大地坐标为(XA,YA)，其后的点所在区域依次为B、C、D，各区域中心点大地坐标分别为(XB,YB)、(XC,YC)和(XD,YD)，航线前本文档来自技高网...

【技术保护点】
1.一种基于A*算法的同区域多条无碰撞航线规划方法，其特征在于步骤如下：/n步骤1：获取飞行空域、禁飞区及任务目标区，飞行空域、禁飞区及任务目标区由封闭凸多边形进行定义，任务目标区必须被飞行空域完全包含，飞行空域只能为一个，禁飞区及任务目标区可以为一个或多个；/n根据给定的飞行空域确定规划区域范围，规划区域由多个边长为K

【技术特征摘要】
1.一种基于A*算法的同区域多条无碰撞航线规划方法，其特征在于步骤如下：
步骤1：获取飞行空域、禁飞区及任务目标区，飞行空域、禁飞区及任务目标区由封闭凸多边形进行定义，任务目标区必须被飞行空域完全包含，飞行空域只能为一个，禁飞区及任务目标区可以为一个或多个；
根据给定的飞行空域确定规划区域范围，规划区域由多个边长为KD的正方形组成，KD为给定的常数，取值为两架无人机之间的允许最小间隔；规划区域的范围为飞行空域的最小外接矩形区域；
步骤2：获取规划起点Si及终点Ei，其中i＝1,2,...,n，n为任务区域数量，Si为无人机起飞点，Ei为每个任务目标区的进入点，起点、终点与任务目标区一一对应，将规划区域内每个最小正方形网格作为一个节点，所有节点信息均初始化为能通过，再分别计算步骤1中获取的飞行空域、禁飞区及任务目标区所有边界穿越的节点，并将对应的节点信息设置为不能通过，最后计算起点及终点所在节点，并设置搜索起点及搜索终点，从而完成搜索地图初始化；
步骤3：利用A*算法进行由起飞点S1飞往任务区1进入点E1的飞行航线搜索，若路径可达，则执行步骤4；若路径不可达，则需重新调整E1的位置，更新E1节点信息，再执行步骤3；使用A*算法搜索航线的过程中设定的条件如下：
(1)可以进行扩展的节点限定为当前节点的上、右、下和左四个节点；

【专利技术属性】
技术研发人员：肖佳伟，麻兴斌，王晶，薛博文，
申请(专利权)人：西安爱生技术集团公司，西北工业大学，
类型：发明
国别省市：陕西;61