一种基于冲突搜索的多无人机的协同路径规划方法技术

本发明专利技术提出一种基于冲突搜索的多无人机的路径规划方法，不仅使搜索出来的路径更符合无人机的飞行特性，更大量减少了路径规划过程中扩展节点的数量，提高了总体的规划效率。包括：将无人机采集到的点云地图预处理为体素网格地图；对所述体素网格地图进行低层级搜索，得到单个无人机的路径；根据所述单个无人机的路径，遍历约束树对所有无人机的轨迹进行冲突检测，若存在冲突则对无人机增加约束，并进行有约束的路径规划，若不存在冲突，则规划成功。则规划成功。则规划成功。

【技术实现步骤摘要】
一种基于冲突搜索的多无人机的协同路径规划方法


[0001]本专利技术属于机器人
，涉及一种基于冲突搜索的多无人机的协同路径规划方法。

技术介绍

[0002]多机器人系统在监视、搜索和救援以及仓库自动化应用方面具有广泛的应用。相对于单机器人路径规划问题，多机器人路径规划问题所存在的几个特点：
[0003]1)存在更多约束，例如需要保持一定队形，或者需要满足动的先后顺序约束，即某机器人的行动完成作为另一机器人开始行动的条件；
[0004]2)机器人团队内部存在规划冲突问题，即在执行规划路径过程中两机器人可能在同一时刻到达同一位置，导致碰撞。
[0005]多机器人路径规划算法可分为集中式和分布式两大类。集中式是将多机器人看作一个整体，将所有机器人整合成一个多自由度空间。去进行规划和搜索。而分布式是对每个机器人进行单独的路径规划。之后再通过协同和调度方法对单个机器人的路径进行协调和修改来解决冲突问题。
[0006]现在针对于多无人机的路径规划算法大多是分布式的。对于多无人机的编队问题，就主要是通过分布式的路径规划算法，通过一种完全去中心化的方法，只规划“领头”机器人，其他机器人只是在避障的同时“跟随领导”，来实现无人机的编队问题。而集中式规划算法，Sharon等人在2015年提出了一种基于冲突的多机器人协作最优路径规划的方法，利用约束树来解决多个机器人之间的路径冲突问题。
[0007]对于现有的多无人机路径规划算法，大多是分布式的，能保证有解，但是不是最优解，在复杂狭窄、高冲突风险的空间中的飞行安全性不能得到保证。Sharon等提出的基于冲突的多机器人协作最优路径规划的方法能很好解决多机器人在路径规划中轨迹冲突的问题，但是在实际应用中不能完全适用于无人机。该算法只能去解决二维平面上多机器人碰撞的问题，而无人机的运动环境是一个三维空间。并且并没有考虑到机器人的实际模型，在现实应用中很难做到轨迹无碰撞。

技术实现思路

[0008]本专利技术提出一种基于冲突搜索的多无人机的路径规划方法，不仅使搜索出来的路径更符合无人机的飞行特性，更大量减少了路径规划过程中扩展节点的数量，提高了总体的规划效率。
[0009]为实现上述目的，本专利技术的技术方案如下：
[0010]一种基于冲突搜索的多无人机的协同路径规划方法，包括：
[0011]将无人机采集到的点云地图预处理为体素网格地图；
[0012]对所述体素网格地图进行低层级搜索，得到单个无人机的路径；
[0013]根据所述单个无人机的路径，遍历约束树对所有无人机的轨迹进行冲突检测，若
存在冲突则对无人机增加约束，并进行有约束的路径规划，若不存在冲突，则规划成功。
[0014]本专利技术有益效果：
[0015]本专利技术通过构造约束树对产生碰撞的机体进行的约束以得到安全的飞行序列，极大提高了无人机群在复杂狭窄、高冲突风险的空间中的飞行安全性；同时在低层搜索过程中结合HybridAstar算法，通过引入无人机运动学和动力学模型，不仅使搜索出来的路径更符合无人机的飞行特性，更大量减少了路径规划过程中扩展节点的数量，提高了总体的规划效率。
附图说明
[0016]图1是本专利技术基于冲突搜索的多无人机的路径规划方法流程图；
[0017]图2是本具体实施方式中点云地图预处理为体素网格地图流程图；
[0018]图3是本具体实施方式中路径规划搜索得到单个无人机的路径流程图。
具体实施方式
[0019]下面结合附图并举实施例，对本专利技术进行详细描述。
[0020]如图1所示，本具体实施方式的一种基于冲突搜索的多无人机的协同路径规划方法，具体包括如下步骤：
[0021]步骤一、将无人机采集到的点云地图预处理为体素网格地图；本实施例中，如图2所示，具体为：
[0022]1.1输入所述点云地图的环境信息，得到点云数据；其中点云地图的障碍物信息包含于三维点云数据中，所述点云数据在世界坐标系下的三维坐标值(x,y,z)表征该位置上存在障碍；
[0023]1.2根据步骤1.1所述的点云数据，计算其在体素网格地图下的三维网格坐标；具体为：
[0024]首先，以物理地图大小为基准设定采样空间，根据预设分辨率对所述采样空间进行分割采样，形成三维的稠密体素网格图，其中分辨率表征地图的精细程度。本实施例中使用的世界地图大小为50
×
50
×
5m，设定分辨率为0.1，则生成的网格地图包含125,000个体素。
[0025]其次，将体素网格图的点云数据由物理坐标值转换到网格坐标值；以x轴坐标为例：
[0026]p
index
＝[p
real
÷
λ][0027]其中p
index
和p
real
分别为数据点的网格坐标值和物理坐标值，λ为预设分辨率，括号“[]”为取整运算符，本实施例采用为向下取整。在具体实施时，该转换过程中的取整运算会导致两个相邻紧密的数据点具有相同网格坐标值，但通过修改分辨率可对其进行调整。
[0028]1.3根据所述体素网格地图以及点云数据的网格坐标，设定并存储每个体素的占据信息；具体为：
[0029]创建一个占据队列，以存储所述体素网格地图中的占据信息，其队列长度与体素网格总数相等，其中所有元素值初始化为0以代表非障碍；存储障碍信息时，将云点数据由物理坐标转换为网格坐标，进而计算其队列索引值，计算公式如下：
[0030]x
index
*Y
size
*Z
size
+y
index
*Z
size
+z
index
[0031]其中x
index
、y
index
、z
index
代表该点网格坐标，Y
size
、Z
size
代表地图在Y轴和Z轴上的最大网格数；该队列索引值是三维数据点在队列中的唯一表征，置该处元素为1以表示该点为障碍；当需判断体素占据情况时，只需查询占据队列中该点队列索引处的元素是否为1即可。
[0032]1.4依据步骤1.3得到的含占据信息的体素网格地图进行地图膨胀；具体实施时，所述地图膨胀的目的是为了将无人机的物理模型近似为一个质点，方便后续的路径规划工作，也即完成无人机由工作空间(Working Space)到构型空间(Configuration Space)的转换。本实施例中，采用依据无人机的体积参数对地图障碍物进行膨胀处理。具体为：
[0033]将无人机近似为一个半径为n的球体，在步骤1.3所得的体素网格地图中，每个被设定为占据的体素则以膨胀半径n为限值向周围的区域进行扩展，得到n3个单元，在占据队列中将所有扩展的节点设定为障碍物，完成地图膨胀。
[0034]步骤二、对步骤一得到的本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，包括：将无人机采集到的点云地图预处理为体素网格地图；对所述体素网格地图进行低层级搜索，得到单个无人机的路径；根据所述单个无人机的路径，遍历约束树对所有无人机的轨迹进行冲突检测，若存在冲突则对无人机增加约束，并进行有约束的路径规划，若不存在冲突，则规划成功。2.如权利要求1所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述预处理为体素网格地图采用以下方式：输入所述点云地图的环境信息，得到点云数据；根据所述点云数据，计算在体素网格地图下的三维网格坐标；根据所述体素网格地图以及三维网格坐标，设定并存储每个体素的占据信息；依据所述占据信息的体素网格地图进行地图膨胀。3.如权利要求2所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述计算在体素网格地图下的三维网格坐标采用以下方式：首先，以物理地图大小为基准设定采样空间，根据预设分辨率对所述采样空间进行分割采样，形成三维的稠密体素网格图，其次，将所述体素网格图的点云数据由物理坐标值转换到网格坐标值。4.如权利要求3所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述根据预设分辨率对所述采样空间进行分割采样时，所述分辨率表征地图的精细程度。5.如权利要求3或4所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述由物理坐标值转换到网格坐标值具体为：p
index
＝[p
real
÷
λ]其中p
index
和p
real
分别为数据点的网格坐标值和物理坐标值，λ为预设分辨率，括号“[]”为取整运算符。6.如权利要求3或4所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述设定并存储每个体素的占据信息，具体为：创建一个占据队列，以存储所述体素网格地图中的占据信息，其队列长度与体素网格总数相等，其中所有元素值初始化为0以代表非障碍；存储障碍信息时，将云点数据由物理坐标转换为网格坐标，进而计算其队列索引值。7.如权利要求6所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述计算其队列索引值计算公式如下：x
index
*Y
size
*Z
size
+y
index
*Z
size
+z
index
其中x
index
、y
index
、z
index
代表该点网格坐标，Y
size
、Z
size
代表地图在Y轴和Z轴上的最大网格数；该队列索引值是三维数据点在队列中的唯一表征，置该处元素为1以表示该点为障碍。8.如权利要求2或3或4所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述依据所述占据信息的体素网格地图进行地图膨胀采用依据无人机的体积参数对地图障碍物进行膨胀处理。9.如权利要求8所述的一种基于冲突搜索的多无人机的协同路径规划方法，其特征在于，所述采用依据无人机的体积参数对地图障碍物进行膨胀处理，具体为：将无人机近似为
一个半径为n的球体，在所述体素网格地图中，每个被设定为占据...

【专利技术属性】
技术研发人员：曾林之，冯思源，宋文杰，钱义肇，刘绩宁，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：