一种面向复杂多边形区域的多智能体协同覆盖探索规划模型及方法
文献发布时间:2024-04-18 19:58:30
技术领域
本发明属于多智能体协同领域,具体地指一种面向复杂多边形区域的多智能体协同覆盖探索规划模型及方法。
背景技术
随着人工智能的发展,对于很多复杂的任务,单个智能体无法完成或完成时间成本很高,因此需要多个智能体协同来完成任务,从而使多智能体协同成为一大研究热门。
区域覆盖问题是多智能体协同完成任务的比较普遍的一种。为了在限定的条件下,协同多个智能体,来对目标区域实现全面覆盖,最终需要投入的智能体和时间成本都是最少,即总成本最低的情况下最有效的完成任务。
本发明主要针对多智能体协同,对复杂不规则海域进行覆盖的问题。因为当今海洋资源丰富,而人力探索较为危险,因此需要无人智能体来对复杂海域进行探索。探索的第一步就是利用多智能体进行区域覆盖。
国内外研究者们在基于多智能体协同的不规则海域区域覆盖问题上都取得了一定的研究成果。他们通过优化算法、改进协同机制和应用先进的通信技术,提高了海域区域覆盖的效率和准确性。然而,仍然存在一些挑战,例如海洋环境的复杂性、通信限制和路径规划的优化等问题,需要进一步的研究和探索。未来的工作可以聚焦于算法改进、系统优化和应用拓展,以提升基于多智能体协同的不规则海域区域覆盖的性能和应用范围。
发明内容
本发明针对上述问题,主要解决了多智能体协同复杂不规则海域区域覆盖中,路径规划过程中预设轨迹与轨迹交叉的问题。
针对目前大多数多智能体协同区域覆盖算法不适应复杂的不规则多边形海域,智能体重复遍历、轨迹交叉,算法收敛性交叉,无法避开突发危险,不能满足多智能体协同在复杂海域情况下的最优区域覆盖的问题。本发明基于混合粒子群算法,改进设计了一个面向复杂不规则海域的多智能体协同区域覆盖模型算法,使其能够提高在复杂海域情况下的探索成本和最优成本下的区域覆盖效率,并且及时规避突发威胁。本发明通过以下技术方案实现上述技术目的。
本发明提出了一种面向复杂不规则多边形海域的多智能体协同区域覆盖规划模型与算法,包括最优覆盖方向选定模块、最优预设轨迹生成模块、最优协同路径规划模块、威胁规避模块、最优路径动态求解算法;
所述最优覆盖方向选定模块:用于选取智能体覆盖复杂多边形海域的整体运动方向;
所述最优预设轨迹生成模块:用于生成智能体覆盖全部区域的最少转角预设轨迹;
所述最优协同路径规划模块:在智能体数确定的情况下,以最小覆盖成本为优化目标,建立优化数学模型;
威胁规避模块:在智能体探索到威胁目标后,及时重新对路径进行局部规划以规避危险。
所述最优路径动态求解算法:以上述最优协同路径规划模块为基础,在覆盖过程中遇到目标,动态修正规划路径,以保证在不进入威胁范围的情况,求取全局最优的多智能体协同区域覆盖路径。
进一步,所述最优覆盖方向选定模块,具体设计如下:
本发明假设智能体对需要覆盖的区域,在垂直于给定扫掠方向的预设轨迹中来回运动,如图2所示。
在沿着这些预设轨迹进行飞行时,智能体姿态保持稳定,摄像头垂直对准海平面。但在该轨迹的末尾,它会在该区域外形成一条曲线以返回到下一条预设轨迹。此外,圈数与给定区域的覆盖时间直接相关。因此,本发明的第一步是找到最佳覆盖方向,该方向垂直于不规则多边形区域的最小高度的方向。在这个方向上,该区域可以用最少的轨迹数覆盖,因此也可以用最少的曲线覆盖,正如图2所示。在考虑路径长度、时间和能量等成本的情况下,转弯较少的路径更有效。
为了找到给定多边形区域的最佳覆盖方向。如图3所示,使多边形在二维坐标系(所述二维坐标系是基于多边形区域形状所在屏幕的二维坐标系)上旋转,并测量其不同方向的高度,最佳扫描轨迹方向是高度最小的方向。
进一步,所述最优预设轨迹生成模块,即在找到最佳扫描方向后,就可以将预设轨迹分布在该区域上。两条轨迹之间的距离(m),为两条轨迹之间的距离被选择为机载相机在海平面上的覆盖面积的函数,已知智能体的扫描宽度为L,L为150m,可得覆盖预设轨迹数:
式中,N
假设表示区域的多边形以最佳覆盖方向平行于全局参考二维坐标系x轴的方式旋转,覆盖轨迹可以由具有相同y坐标的两个平面点(x,y)得出:
x坐标由纵坐标为y
覆盖轨迹的极值点,以及智能体起始位置的坐标(基地或仓库),为图G=(V,E)的点集V。图中的每个节点都已编号,因此第一架智能体的起始点编号为1,其他智能体的起始点编号以此类推,与第一行覆盖轨迹相关的节点的编号为2和3,与第二行相关的节点的编号为4和5,依此类推。最后,每行覆盖轨迹都与后续的偶数和奇数编号节点相关联。边集E由连接图的N个节点的所有线组成,从而形成一个完整的图,即为最优预设轨迹,如图4所示。
将图G表示为N×N成本矩阵C,其元素C
进一步,所述最优协同路径规划模块,在创建了与要覆盖的区域相关联的图以后,将最优协同路径规划问题视为VRP(Vehicle Routing Problem)问题。在这类问题中,一组智能体必须拜访一组客户。为了将最优协同路径规划问题转化为VRP,将每个智能体视作智能体,覆盖轨迹的每个极值点视为客户。此外,通过提出新的约束,可以强制智能体在它们的路径图中使用一些预先指定的边。因此,其中智能体肯定会跟随覆盖轨迹。最后,通过求解VRP,可以获得每个智能体必须执行的一组路线。具体地:
成本矩阵C中的元素C
根据上述定义的变量,可得第k个智能体遍历其路线所花费的时间T
本发明的主要目标是尽量减少任务时间,这可以通过最小化所有智能体路径中最长路径的飞行时间来实现。因此,本发明要解决的问题实际上是一个想要最小化T
min(υ)
其中,t
由于智能体起飞的设置时间可以忽略,所以本发明后续对t
上式中的约束强制每个节点,仅由一架智能体访问,并且保证到达给定节点的智能体与离开该节点的智能体相同。
为确保每个智能体路径从起始点开始,在全部遍历完结束,并保证路径没有内部循环,使用标准子巡回消除约束:
其中,
为了确保VRP的解能使智能体覆盖转化为图G的整个多边形海域,加入如下约束:
此约束强制每个智能体在访问覆盖轨迹的一个节点后,必须访问该行轨迹的另一个节点,也保证访问偶数节点的智能体也访问下一个奇数节点;此外,访问奇数节点的智能体必须访问前一个偶数节点。
为了避免智能体沿着不平行于覆盖范围的边缘穿过覆盖区域的预设轨迹,可以将两个可选约束添加到上文的优化模型中。
在实践中,上面两个约束可以避免智能体执行急转弯以及在不同方向拍摄照片。如果这些问题对于给定任务不重要,则可以忽略这两个约束,不会影响任务的执行。
最后,结合可用智能体的数量,可以建立如下约束:
其中,发明主要针对智能体数量固定的情况。因此,在固定智能体数量的情况下,本发明主要针对智能体的最大飞行路径长度进行最小化的优化。
基于多智能体协同的不规则海域区域覆盖算法设计
本设计主要使用前端的Yalmip工具箱和后端的Gurobi求解器来求解全图最优遍历模型。
首先根据任务范围,由findwaypoints函数求取合适的覆盖轨迹的航路点。输入不规则海域的图模型点集V与待遍历位置的点集X,以智能体的运动能力为基础,遍历所有需求位置为约束,迭代输出不规则海域覆盖轨迹的航路点。
表1-1findwaypoints函数
获得全图覆盖预设轨迹的航路点以后,可进一步使用Gurobi求解器,结合线性迭代算法,对最优路径进行求解。输入不规则海域的图模型点集V、智能体信息(运动速度、启动时间、最大飞行时间)、和Gurobi优化器配置参数h与O,根据计算的欧式距离选取合适的优化器配置,进行路径规划,输出规划的路径与智能体的分配。
表1-2lip函数
在全图遍历的过程中,还要完成所有静目标的探索工作。输入智能体的坐标与探测范围,在范围内进行搜寻,如果范围内存在静目标,则输出对应静目标的坐标。
表1-3searchtargets函数
本发明的有益效果:
1.本发明基于多智能体强化学习需要大量的场景来训练模型,并且对一些突发的复杂工况不能有效的处理,出于安全的考虑,本发明提出了一种基于规则的区域覆盖路径规划策略,在实现上更为容易、快捷,以解决多智能体协同在复杂区域探索方面的问题。
2.本发明基于混合粒子群算法,改进设计了一个面向复杂不规则海域的多智能体协同区域覆盖模型算法,使其能够提高在复杂海域情况下的探索成本和最优成本下的区域覆盖效率,并且及时规避突发威胁。
3.本发明针对复杂海域下多智能体协同探查技术需要根据探查工作的实际需求,对多个智能体进行协调控制与规划,兼顾探查的精度与探查的速度,为后期各类海洋工程提供精确的测量数据,最大化保障海洋工程的安全性与经济性。
附图说明
图1为本发明总体实施流程示意图;
图2为复杂多边形海域覆盖图;
图3为区域覆盖静目标探查;
图4为多智能体协同复杂不规则海域覆盖算法流程。
具体实施方式
下面结合附图对本发明作进一步说明。
如图1所示,本发明的具体实施如下:
步骤一:不规则多边形海域面积分解
本发明假设智能体对需要覆盖的区域,在垂直于给定扫掠方向的预设轨迹中来回运动,如图2所示;
在沿着这些预设轨迹进行飞行时,智能体姿态保持稳定,摄像头垂直对准海平面。但在该轨迹的末尾,它会在该区域外形成一条曲线以返回到下一条预设轨迹。此外,圈数与给定区域的覆盖时间直接相关。因此,本发明方法的第一步是找到最佳覆盖方向,该方向垂直于不规则多边形区域的最小高度。在这个方向上,该区域可以用最少的轨迹数覆盖,因此也可以用最少的曲线覆盖,如图2所示。在考虑路径长度、时间和能量等成本的情况下,转弯较少的路径更有效。
为了找到给定多边形区域的最佳覆盖方向,可以使用简单的搜索过程,如图3所示,使多边形在二维坐标系上旋转,并测量其不同方向的高度,最佳扫描轨迹方向是高度最小的方向。
进一步,所述最优预设轨迹生成模块,即在找到最佳扫描方向后,就可以将预设轨迹分布在该区域上。而两条轨迹之间的距离(m),为两条轨迹之间的距离被选择为机载相机在海平面上的覆盖面积的函数,已知智能体的扫描宽度为L=150m,可得覆盖预设轨迹数:
式中,N
假设表示区域的多边形以最佳覆盖方向平行于全局参考系x轴的方式旋转,覆盖轨迹可以由具有相同y坐标的两个平面点(x,y)得出:
x坐标由纵坐标为y
覆盖轨迹的极值点,以及智能体起始位置的坐标(基地或仓库),为图G=(V,E)的点集V。图中的每个节点都已编号,因此第一架智能体的起始点编号为1,其他智能体的起始点编号以此类推,与第一行覆盖轨迹相关的节点的编号为2和3,与第二行相关的节点的编号为4和5,依此类推。最后,每行覆盖轨迹都与后续的偶数和奇数节点相关联。边集E由连接图的N个节点的所有线组成,从而形成一个完整的图,如图4所示。
将图G表示为N×N成本矩阵C,其元素C
步骤二:智能体路径规划策略
进一步,所述最优协同路径规划模型,首先在创建了与要覆盖的区域相关联的图以后,将覆盖问题视为VRP问题。在这类问题中,一组智能体必须拜访一组客户。为了将前面的问题转化为VRP,将每个智能体视作执行车辆,覆盖轨迹的每个极值点视为客户。此外,通过提出新的约束,可以强制智能体在它们的路径图中使用一些预先指定的边。因此其中一架发射的智能体肯定会跟随覆盖轨迹进行运动。最后,通过求解VRP,可以获得每架智能体必须执行的一组路线。
成本矩阵C中的值C
根据上述定义的变量,可得第k个智能体遍历其路线所花费的时间T
本发明的主要目标是尽量减少任务时间,这可以通过最小化所有智能体路径中最长路径的飞行时间来实现。因此,本发明要解决的问题实际上是一个想要最小化T
min(υ)
由于智能体起飞的设置时间可以忽略,所以本发明后续对t
上式中的约束强制每个节点,仅由一架智能体访问,并且保证到达给定节点的智能体与离开该节点的智能体相同。
为确保每个智能体路径从起始点开始,在全部遍历完结束,并保证路径没有内部循环,使用标准子巡回消除约束:
其中,
为了确保VRP的解能使智能体覆盖转化为图G的整个多边形海域,也需加入如下约束:
此约束强制每个智能体在访问覆盖轨迹的一个节点后,必须访问该行轨迹的另一个节点,也保证访问偶数节点的智能体也访问下一个奇数节点;此外,访问奇数节点的智能体必须访问前一个偶数节点。
为了避免智能体沿着不平行于覆盖范围的边缘穿过覆盖区域的预设轨迹,可以将两个可选约束添加到本发明的优化模型中。
在实践中,上面两个约束可以避免智能体执行急转弯以及在不同方向拍摄照片。如果这些问题对于给定任务不重要,则可以忽略这两个约束,不会影响任务的执行。
最后,结合可用智能体的数量,可以建立如下约束:
其中,发明主要针对智能体数量固定的情况。因此,在固定智能体数量的情况下,本发明主要针对智能体的最大飞行路径长度进行最小化的优化。
步骤三:基于多智能体协同的不规则海域区域覆盖算法设计
本发明主要使用前端的Yalmip工具箱和后端的Gurobi求解器来求解全图最优遍历模型。
首先根据任务范围,由findwaypoints函数求取合适的覆盖轨迹的航路点。
表1-1 findwaypoints函数
获得全图覆盖预设轨迹的航路点以后,可进一步使用Gurobi求解器,结合线性迭代算法,对最优路径进行求解。
表1-2 lip函数
/>
在全图遍历的过程中,还要完成所有静目标的探索工作,由如下算法实现。
表1-3searchtargets函数
综上所述,本发明针对目前大多数多智能体协同区域覆盖算法不适应复杂的不规则多边形海域,智能体重复遍历、轨迹交叉,算法收敛性交叉,无法避开突发危险,不能满足多智能体协同在复杂海域情况下的最优区域覆盖的问题。本发明基于混合粒子群算法,改进设计了一个面向复杂不规则海域的多智能体协同区域覆盖模型算法,使其能够提高在复杂海域情况下的探索成本和最优成本下的区域覆盖效率,并且及时规避突发威胁。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技术所创的等效方式或变更均应包含在本发明的保护范围之内。
- 一种面向区域目标的多星协同覆盖快速规划方法
- 一种面向多智能体任务规划的复杂优化方法