一种面向无人机群体快速目标搜索的协同主动感知方法技术

本发明专利技术公开了一种面向无人机群体快速目标搜索的协同主动感知方法，属于多无人机区域监视技术领域。包括：根据无人机群体的目标监视区域设定目标位置；将多无人机三维轨迹规划解耦为水平和垂直方向的规划问题，基于树形动态增长自组织映射算法确定多无人机协同搜索在水平方向的规划顺序，调整无人机群体的飞行高度，访问所有目标位置邻域；利用分段平滑曲线实现无人机群体的平滑闭环三维轨迹规划；结合无人机路径速度和加速度约束，利用速度剖面计算来解决多无人机协同区域主动感知的最短时间优化问题。以上过程同时进行，以此规划出的航路使得多无人机在最短时间内，尽可能多访问目标物体位置，实现协同快速目标搜索，完成主动感知任务。

【技术实现步骤摘要】
一种面向无人机群体快速目标搜索的协同主动感知方法
本专利技术属于多无人机区域监视
，尤其是涉及一种面向无人机群体快速目标搜索的协同主动感知方法。
技术介绍
无人机是一种有动力驱动且能够携带任务设备，具备超视距飞行和自主飞行能力的无人驾驶飞行器。凭借其制造成本低和体积小，机动性强等特点，在军用和民用等领域发挥着越来越重要的作用。多架无人机共同执行任务及相关研究逐渐成为应用的趋势，区域监视是目前无人机群体控制系统的一项重要任务。其中大范围复杂环境中的协同目标搜索和主动感知是无人机群体控制系统领域待解决的主要问题之一。目前无人机目标搜索的航路规划算法研究大多是以避开障碍物到达飞行目标点为目的，通过相关的航路规划算法计算和选择次优或最优的航路轨迹，多数研究停留在二维轨迹规划领域，且存在计算量大，鲁棒性不佳等缺陷。经对现有技术文献的研究发现，多数利用改进A*算法、粒子群算法进行无人机轨迹规划，但A*算法搜索速度慢，计算量大，很难在保证在多约束条件下找到无人机最优航迹，粒子群算法规划空间划分较粗糙、难以满足飞行约束条件，不能在可选路径集之外的空间搜索，且粒子群算法精确度不够高，难以在复杂环境和多约束条件下找到最优航迹。树形动态增长自组织映射算法是一种无监督学习的竞争性神经网络算法，是在基本自组织映射算法上进行的改进，采用灵活的树形结构，算法执行效率较高。目前该算法已应用于数据聚类领域，少数论文将自组织映射算法应用于单个无人机在线轨迹规划，且多集中在二维空间。在无人机群体目标搜索领域，尚无专利利用该算法实现无人机群体三维航迹规划任务。
技术实现思路
专利技术目的是为了克服已有技术的不足之处，提供一种面向无人机群体快速目标搜索的协同主动感知方法，本专利技术针对大规模且不完全已知的复杂环境，利用树形动态增长自组织映射算法和Bezier平滑规划解决多约束下无人机群体协同区域目标搜索的航迹快速规划和主动感知问题。本专利技术针对多架无人机持续监视的指定区域，对复杂环境中的目标进行协同目标搜索，快速完成搜索区域内的目标观测，为每架无人机规划出一条最有效的三维空间航迹，以最小代价和最快速度搜索并观测到目标，实时最大化收集区域信息，实现无人机群体的主动感知，达到有效地监视大规模区域的目的。为实现上述目的，本专利技术采用如下技术方案予以实现。本专利技术提出的一种面向无人机群体快速目标搜索的协同主动感知方法，其特征在于，包括如下步骤：1)根据无人机群体的目标监视区域，设定该无人机群体的n个目标位置；所述无人机群体包含N架独立运动的无人机，每架无人机上搭载有视觉传感器，根据各视觉传感器的感应距离，设定每架无人机的监视半径，将该监视半径作为各目标位置的邻域；2)基于树形动态增长自组织映射算法确定无人机群体轨迹的访问节点，具体包括以下步骤：2.1)将无人机群体的三维轨迹规划解耦为水平和垂直方向的规划问题；2.2)基于树形动态增长自组织映射算法产生和更新无人机群体闭环轨迹的访问节点，确定无人机群体协同搜索在水平方向的闭环轨迹顺序，并调整无人机群体的飞行高度；遍历所有目标位置的邻域；3)对步骤2)最终确定的无人机群体三维轨迹的访问节点通过分段平滑曲线及局部迭代优化方法规划无人机群体的平滑闭环三维轨迹；4)根据步骤3)得到的无人机群体平滑闭环三维轨迹设定无人机群体运动控制中的路径速度和加速度约束条件，根据设定的路径速度和加速度约束条件计算无人机群体的速度剖面，根据该速度剖面求解多无人机协同区域主动感知的最短时间对应的路径，通过该路径控制无人机群体实现目标搜索。本专利技术提供的一种面向无人机群体快速目标搜索的协同主动感知方法，针对大规模且不完全已知的复杂环境，基于树形动态增长自组织映射算法和Bezier平滑规划方法，以解决多约束下无人机群体协同区域目标搜索的航迹快速规划问题。相比于现有技术，具有以下有益效果：1)相对于单无人机航迹规划方法，本专利技术能解决无人机群体的快速三维航迹规划问题，完成目标搜索任务，实现无人机群体的主动感知。无人机在航行阶段能够根据实际环境调整飞行高度和速度，适用于不同地形；以最小代价和最快速度搜索并观测到目标，实时最大化收集区域信息。2)本专利技术解决了多无人机多协同航迹规划问题，为提高算法执行效率，将基于树形动态增长自组织映射算法和Bezier平滑规划用于航迹快速规划和主动感知问题，本专利技术方法具有收敛速度快，收敛精度高的优点。3)和传统的Dubins曲线约束不同，无人机群体可以直线加速，小半径小速度转弯，不受无人机最小正向速度和最小转弯半径约束，而是受无人机最大速度和最大加速度制约，因此本专利技术采用三阶Bezier曲线进行平滑规划，提高该方法在实际场景中的实用性和高效性。附图说明图1面向无人机群体快速目标搜索的协同主动感知方法流程图；图2无人机群体、目标位置和目标位置领域的相对位置关系图；图3节点更新与调整流程图。具体实施方式下面结合附图对本专利技术作进一步说明。参照图1为本专利技术的一种面向无人机群体快速目标搜索的协同主动感知方法流程图，特别适用于无人机群体在多约束条件下、对大规模且不完全已知的复杂目标区域进行实时快速目标搜索和航迹规划，本方法具体包括以下步骤：1)设置无人机的数目N、各无人机起点以及后续计算的最大迭代次数。根据无人机群体的目标监视区域，设定该无人机群体的n个目标位置；所述无人机群包含N架独立运动的无人机，每架无人机上分别搭载一个视觉传感器，根据该视觉传感器的感应距离设定每架无人机的监视半径R(本实施例中，各视觉传感器相同，故每架无人机的监视半径R均相等，且设定为视觉传感器的感应距离)。为了节省目标搜寻时间，提高主动感知的效率和适应性，将设定的监视半径作为各目标位置的邻域，无人机群体只需在监视半径内观测到目标，即可视为达到观测效果。图2为无人机群体(本实施例由3架无人机构成无人机群体)、目标位置和目标位置邻域的相对位置关系图，其中，点A,B,C为无人机群体的起点，黑色点为监视区域的目标位置，灰色圆形区域为目标位置的邻域。2)基于树形动态增长自组织映射算法确定无人机群体轨迹的访问节点，具体包括以下步骤：2.1)将无人机群体的三维轨迹规划在二维轨迹规划基础上进行拓展，即将无人机群体的三维轨迹规划解耦为水平和垂直方向的规划问题，无人机群体中各无人机在三维空间的轨迹规划中，位置表示为：其中，θ为无人机的转弯角，ψ为无人机的俯仰角；以机器人底盘圆心为原点，机器人底盘所在平面上任意互为垂直关系的两个方向作为x、y轴建立坐标系，z轴与x、y轴满足右手螺旋定则；2.2)基于树形动态增长自组织映射算法产生和更新无人机群体闭环轨迹(每架无人机对应一个闭环轨迹)的访问节点，确定无人机群体协同搜索在水平方向的闭环轨迹顺序，并调整无人机群体的飞行高度；遍历所有目标位置的邻域。其流程图参见图3，具体实现过程如下(在执行过程中，各无人机同步完成下述各步骤)：2.2.1)构建树形动态增长自组织映射双层神经网络，随机选择根节点，设该双层神经网络内的各神经元节点分别与无人机群体闭环轨迹上的一个访问节点相对应，将无人机群体的目标位置作为树形动态增长自组织映射双层神经网络的输入层，将无人机群体N个闭环轨迹的共计n个访问节点作为树形动态增长自组织映射双层神经网络的输出层，经本文档来自技高网...

【技术保护点】
1.一种面向无人机群体快速目标搜索的协同主动感知方法，其特征在于，包括如下步骤：1)根据无人机群体的目标监视区域，设定该无人机群体的n个目标位置；所述无人机群体包含N架独立运动的无人机，每架无人机上搭载有视觉传感器，根据各视觉传感器的感应距离，设定每架无人机的监视半径，将该监视半径作为各目标位置的邻域；2)基于树形动态增长自组织映射算法确定无人机群体轨迹的访问节点，具体包括以下步骤：2.1)将无人机群体的三维轨迹规划解耦为水平和垂直方向的规划问题；2.2)基于树形动态增长自组织映射算法产生和更新无人机群体闭环轨迹的访问节点，确定无人机群体协同搜索在水平方向的闭环轨迹顺序，并调整无人机群体的飞行高度；遍历所有目标位置的邻域；3)对步骤2)最终确定的无人机群体三维轨迹的访问节点通过分段平滑曲线及局部迭代优化方法规划无人机群体的平滑闭环三维轨迹；4)根据步骤3)得到的无人机群体平滑闭环三维轨迹设定无人机群体运动控制中的路径速度和加速度约束条件，根据设定的路径速度和加速度约束条件计算无人机群体的速度剖面，根据该速度剖面求解多无人机协同区域主动感知的最短时间对应的路径，通过该路径控制无人机群体实现目标搜索。...

【技术特征摘要】
1.一种面向无人机群体快速目标搜索的协同主动感知方法，其特征在于，包括如下步骤：1)根据无人机群体的目标监视区域，设定该无人机群体的n个目标位置；所述无人机群体包含N架独立运动的无人机，每架无人机上搭载有视觉传感器，根据各视觉传感器的感应距离，设定每架无人机的监视半径，将该监视半径作为各目标位置的邻域；2)基于树形动态增长自组织映射算法确定无人机群体轨迹的访问节点，具体包括以下步骤：2.1)将无人机群体的三维轨迹规划解耦为水平和垂直方向的规划问题；2.2)基于树形动态增长自组织映射算法产生和更新无人机群体闭环轨迹的访问节点，确定无人机群体协同搜索在水平方向的闭环轨迹顺序，并调整无人机群体的飞行高度；遍历所有目标位置的邻域；3)对步骤2)最终确定的无人机群体三维轨迹的访问节点通过分段平滑曲线及局部迭代优化方法规划无人机群体的平滑闭环三维轨迹；4)根据步骤3)得到的无人机群体平滑闭环三维轨迹设定无人机群体运动控制中的路径速度和加速度约束条件，根据设定的路径速度和加速度约束条件计算无人机群体的速度剖面，根据该速度剖面求解多无人机协同区域主动感知的最短时间对应的路径，通过该路径控制无人机群体实现目标搜索。2.根据权利要求1所述的面向无人机群体快速目标搜索的协同主动感知方法，其特征在于：所述步骤2.2)是通过以下步骤实现：2.2.1)构建树形动态增长自组织映射双层神经网络，随机选择根节点，设该双层神经网络内的各神经元节点分别与无人机群体闭环轨迹上的一个访问节点相对应，将无人机群体的目标位置作为树形动态增长自组织映射双层神经网络的输入层，将无人机群体N个闭环轨迹的共计n个访问节点作为树形动态增长自组织映射双层神经网络的输出层，输出的各访问节点分别位于对应的一个目标位置的邻域内；2.2.2)将各无人机的闭环轨迹上各个相邻访问节点之间分别以三阶分段Bezier曲线相连，各无人机分别由m条分段曲线组成各自的一个平滑闭环轨迹；2.2.3)对于无人机群体的当前目标位置，分别遍历各无人机闭环轨迹上各访问节点之间的分段曲线，找到闭环轨迹上距离当前目标位置航点最近的点，将其作为新增访问节点；其中，所述目标位置航点为访问节点与相应目标位置连线上且位于该目标位置的邻域范围内的任意一点；若该新增访问节点在目标位置邻域内，则该新增访问节点的位置不作调整，执行步骤2.2.4)；若该新增访问节点在相应目标位置的邻域外，则调整与各目标位置对应的其他访问节点向该目标位置的航点处靠近，调整方法如下：v′＝v+μf(σ，d)(v*.sp-v)其中，v为待调整访问节点的位置；v′为调整后访问节点的位置；μ为树形动态增长自组织映射算法的学习率，0＜μ＜1；f(σ，d)为访问节点的邻域函数，σ为树形动态增长自组织映射算法的增益率，0＜σ＜1，d表示待调整的访问节点到新增访问节点的距离，M为各无人机闭环轨迹中调整前的访问节点的个数，v*·sp为与待调整访问节点所对应的目标位置航点的位置；2.2.4)各无人机闭环轨迹上其他的目标位置...

【专利技术属性】
技术研发人员：刘华平，吴莹莹，丁肇红，赵怀林，孙富春，王华鲜，
申请(专利权)人：清华大学，
类型：发明
国别省市：北京,11