一种基于二维栅格划分的集群无人机多航迹规划方法技术

本发明专利技术属于无人机多航迹规划技术领域，具体涉及一种基于二维栅格划分的集群无人机多航迹规划方法。步骤为：用栅格法将二维空间规划为若干正方形网格；建立无人机威胁约束模型；初始化量子蚁群，初始化量子信息素并将所有量子蚂蚁置于初始节点；所有量子蚂蚁根据禁忌搜索和量子信息素更新节点选择概率等机制完成路径搜索；根据最优路径的综合代价更新量子旋转角；使用模拟的量子旋转门更新量子信息素；将输出的最优路径存入航迹集合；判断航迹集合中的航迹个数是否到达最大航迹个数；将航迹集合中的航迹依长度排序供无人机选择。将传统蚁群算法的启发式搜索机制与量子计算和禁忌搜索相结合，提供一种获取多条选择路径的集群无人机航迹规划方法。

A multi track planning method for cluster unmanned aerial vehicle based on two-dimensional grid division

【技术实现步骤摘要】
一种基于二维栅格划分的集群无人机多航迹规划方法
本专利技术属于无人机多航迹规划
，具体涉及一种基于二维栅格划分的集群无人机多航迹规划方法。
技术介绍
无人机的航迹规划是指根据飞行任务的需要，设计出使无人机从起点到目标点的最优飞行轨迹，要求符合无人机机动性能约束并使综合代价最小。无人机的航迹规划是为圆满完成任务而作的飞行计划。合理的规划使无人机能有效地规避威胁，提高生存概率及作战效率。在实际的航迹规划过程中，由于实际环境的复杂性，无人机很难事先获得全部的威胁和环境信息，而且这些因素也可能会实时发生改变，这可能会导致预先规划的单条最优航迹在无人机执行任务时无法使用。另一方面，当多机协同执行任务时，往往需要规划多条不同的航迹，从不同的方向到达目标区域执行任务。要解决上述问题一种有效的途径就是使用多航迹规划方法，预先规划出多条航迹，然后在执行任务时根据不同的需要临时决定合适的航迹或多机协同航迹。本专利技术考虑无人机集群作战情境下的航迹规划。无人机集群作战是指一组具备部分自主能力的无人机系统通过有人或无人操作装置的辅助，在一名高级操作员的监控下，完成作战任务的过程。集群无人机航迹规划则要求集群内无人机自主飞向任务区域的同时，避免与其它无人机发生碰撞，并且需要根据前方无人机反馈的敌人设置的新打击点信息来调整后续无人机的飞行路线。要满足上述要求同样需采取多航迹规划方法。航迹规划算法大致分为两类，确定性计算方法和启发式优化算法。确定性计算方法如A*算法，虽然该算法具有运算量小和收敛性强的优点，但是它只能生成一条航迹，不适合需要多条航迹的集群作战系统。而启发式优化算法如蚁群算法，由于其采用随机搜索方法，具备可生成多个解的特性，因而在一定程度上满足了无人机集群作战系统的需要。但是传统的蚁群算法的信息素更新方式容易导致其丧失种群多样性而陷入局部最优，因而本专利技术考虑结合量子计算和禁忌搜索的方法，使用模拟的量子旋转门对信息素进行更新，既能够保证求解的路径的有效性，能够求出综合代价最小的路径，又不失路径的多样性，能够获取综合代价相对较小可供集群作战系统选择的多条路径。
技术实现思路
本专利技术的目的在于提供一种获取多条选择路径的集群无人机航迹规划方法，具体涉及一种基于二维栅格划分的集群无人机多航迹规划方法。本专利技术的目的是这样实现的：一种基于二维栅格划分的集群无人机多航迹规划方法，具体的实现步骤如下：步骤1.用栅格法将二维空间规划为若干正方形网格，设二维空间横坐标范围为[xmin,xmax]，纵坐标范围为[ymin,ymax]，网格大小为G，则每列有h＝(ymax-ymin)/G个网格，每行有v＝(xmax-xmin)/G个网格，网格总数为n＝h·v，取每个网格左下角的网格节点代表对应的网格，并按照从下往上、从左往右的顺序给网格编号，则编号为k的网格节点编号计算公式为k＝1,2,...,n，(xk,yk)为第k个网格节点的空间坐标；步骤2.建立无人机威胁约束模型，设区域中存在NR个雷达威胁点、NM个导弹威胁点、NA个高炮威胁点及NC个大气威胁点，记第l1，l1＝1,2,...,NR个雷达威胁点坐标为雷达威胁点在节点k处产生的威胁代价为第l2，l2＝1,2,...,NM个导弹威胁点坐标为导弹威胁点在节点k处产生的威胁代价为第l3，l3＝1,2,...,NA个高炮威胁点坐标为高炮威胁点在节点k处产生的威胁代价为第l4，l4＝1,2,...,NC个大气威胁点坐标为大气威胁点在节点k处产生的威胁代价为则所有威胁点在节点k处产生的总威胁代价为其中δR、δM、δA和δC分别为雷达威胁、导弹威胁、高炮威胁和大气威胁的权重；步骤3.初始化量子蚁群，将节点i与节点j间路径的量子信息素浓度初始化为i＝1,2,…,n，j＝1,2,...,n，得到量子信息素矩阵同时将H只量子蚂蚁置于起始节点，n为网格节点总数，t为迭代次数，初始时设t＝0；步骤4.所有量子蚂蚁各自进行路径搜索；步骤5.取H只量子蚂蚁中到达目标节点且长度最短的路径作为最优路径，更新最优路径节点集合ROUTEt、最优路径长度Lt以及最优路径的综合代价其中表示第t次迭代得到的最优路径集合中所有节点威胁代价之和；步骤6.根据最优路径的综合代价φt更新量子旋转角更新方式如下：其中Q为角度调节因子；步骤7.对于每两个节点i，j，i＝1,2,...,n，j＝1,2,...,n间的量子信息素采用模拟的量子旋转门，按照以下方式更新：其中i＝1,2,...,n，j＝1,2,...,n；步骤8.如果达到最大迭代次数，迭代终止，输出的最优路径即为无人机可选航迹的一个潜在解，并将其存入航迹集合D，否则，设t＝t+1并将H只量子蚂蚁置于起始节点，并返回步骤4继续进行；步骤9.如果得到K条航迹潜在解，则执行步骤10，否则，返回步骤3继续进行；步骤10.将得到的K条航迹按照它们长度的升序排列即可得到无人机的不同长度的航迹集合。步骤4中所述的量子蚂蚁的路径搜索中，对第h，h＝1,2,...,H只量子蚂蚁，按照以下操作，即每次从当前节点依概率转移到下一节点，直至H只量子蚂蚁中的每一只到达目标节点或可选节点集合为空，令h＝1，开始执行以下操作，(1)初始时起始节点为当前节点，用e表示当前节点；(2)根据第h只量子蚂蚁的当前节点e更新禁忌列表禁忌列表包括当前节点以及n个网格节点中受任一威胁点的威胁代价为1的所有节点；(3)根据第h只量子蚂蚁的当前节点e以及当前禁忌列表更新量子蚂蚁h的可选节点集合表示量子蚂蚁h所在节点e的相邻节点集合，表示n个网格节点中在禁忌列表外的节点；(4)判断可选节点集合是否为空，若则执行(5)，若则量子蚂蚁h停止移动，并转至(7)；(5)计算从当前节点转移到可选节点集合中每一个可选节点的概率，并通过轮盘赌选择并移动到下一个节点，在第t次迭代中，量子蚂蚁h从节点当前节点e转移到可选节点b，的概率其中为第t次迭代中节点e与节点b间路径的量子信息素浓度，ηb为节点b的启发因子，也为b点的总威胁代价的倒数，即ηb＝1/εb，λeb为当前节点e与可选节点b间的引导因子，也为两者距离的倒数，即λeb＝1/deb，α、β和γ分别表示量子信息素、启发因子和引导因子的重要性程度；(6)判断新获得的节点是否为目标节点，若是则执行(7)，否则，将其作为新的当前节点，返回(2)；(7)判断是否所有量子蚂蚁都完成路径搜索，若h≠H则令h＝h+1并返回(1)；若h＝H则执行步骤(5)。步骤2中的δR∈[0,1]，δM∈[0,1]，δA∈[0,1]，δC∈[0,1]，且δR+δM+δA+δC＝1。步骤2中的和的计算公式如下：其中为节点k与雷达间的距离，表示雷达的绝对探测半径，表示雷达探测区域的最大半径；其中为节点k与导弹发射点间的距离，表示导弹的杀伤区近界，表示导弹的杀伤区远界；其中为节点k与高炮阵地间的距离，为高炮阵地的火力空域，为高炮阵地的最大射程；其中为节点k与大气威胁中心的距离，表示在大气威胁影响下无人机必然毁伤的区域半径，表示大气威胁影响区域的最大半径。步骤10中的无人机根据以下方式选择相应航迹，方式1.把每个长度集合中的航迹按照威胁代价升序排列，不同编队的无人机选择不同长度集合中威胁代价最小的航迹飞行，或者选择相同长本文档来自技高网...

【技术保护点】
一种基于二维栅格划分的集群无人机多航迹规划方法，其特征在于，具体的实现步骤如下：步骤1.用栅格法将二维空间规划为若干正方形网格，设二维空间横坐标范围为[xmin,xmax]，纵坐标范围为[ymin,ymax]，网格大小为G，则每列有h＝(ymax‑ymin)/G个网格，每行有v＝(xmax‑xmin)/G个网格，网格总数为n＝h·v，取每个网格左下角的网格节点代表对应的网格，并按照从下往上、从左往右的顺序给网格编号，则编号为k的网格节点编号计算公式为

【技术特征摘要】
1.一种基于二维栅格划分的集群无人机多航迹规划方法，其特征在于，具体的实现步骤如下：步骤1.用栅格法将二维空间规划为若干正方形网格，设二维空间横坐标范围为[xmin,xmax]，纵坐标范围为[ymin,ymax]，网格大小为G，则每列有h＝(ymax-ymin)/G个网格，每行有v＝(xmax-xmin)/G个网格，网格总数为n＝h·v，取每个网格左下角的网格节点代表对应的网格，并按照从下往上、从左往右的顺序给网格编号，则编号为k的网格节点编号计算公式为(xk,yk)为第k个网格节点的空间坐标；步骤2.建立无人机威胁约束模型，设区域中存在NR个雷达威胁点、NM个导弹威胁点、NA个高炮威胁点及NC个大气威胁点，记第l1，l1＝1,2,...,NR个雷达威胁点坐标为雷达威胁点在节点k处产生的威胁代价为第l2，l2＝1,2,...,NM个导弹威胁点坐标为导弹威胁点在节点k处产生的威胁代价为第l3，l3＝1,2,...,NA个高炮威胁点坐标为高炮威胁点在节点k处产生的威胁代价为第l4，l4＝1,2,...,NC个大气威胁点坐标为大气威胁点在节点k处产生的威胁代价为则所有威胁点在节点k处产生的总威胁代价为其中δR、δM、δA和δC分别为雷达威胁、导弹威胁、高炮威胁和大气威胁的权重；步骤3.初始化量子蚁群，将节点i与节点j间路径的量子信息素浓度初始化为得到量子信息素矩阵同时将H只量子蚂蚁置于起始节点，n为网格节点总数，t为迭代次数，初始时设t＝0；步骤4.所有量子蚂蚁各自进行路径搜索；步骤5.取H只量子蚂蚁中到达目标节点且长度最短的路径作为最优路径，更新最优路径节点集合ROUTEt、最优路径长度Lt以及最优路径的综合代价其中表示第t次迭代得到的最优路径集合中所有节点威胁代价之和；步骤6.根据最优路径的综合代价φt更新量子旋转角更新方式如下：其中Q为角度调节因子；步骤7.对于每两个节点i，j，i＝1,2,...,n，j＝1,2,...,n间的量子信息素采用模拟的量子旋转门，按照以下方式更新：其中i＝1,2,...,n，j＝1,2,...,n；步骤8.如果达到最大迭代次数，迭代终止，输出的最优路径即为无人机可选航迹的一个潜在解，并将其存入航迹集合D，否则，设t＝t+1并将H只量子蚂蚁置于起始节点，并返回步骤4继续进行；步骤9.如果得到K条航迹潜在解，则执行步骤10，否则，返回步骤3继续进行；步骤10.将得到的K条航迹按照它们长度的升序排列即可得到无人机的不同长度的航迹集合。2.根据权利要求1所述的一种基于二维栅格划分的集群无人机多航迹规划方法，其特征在于：步骤4中所述的量子蚂蚁的路径搜索中，对第h，h＝1,2...

【专利技术属性】
技术研发人员：高洪元，侯阳阳，刘丹丹，刁鸣，程建华，李晋，张世铂，李佳，刘子奇，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23