1.一种基于六边形栅格地图的多AUV任务分配与路径规划方法,其特征在于,包括以下步骤:(1)基于SOM方法对动态环境下的多AUV系统进行任务分配,确保每一个目标都有AUV进行捕获;
(2)构建水下环境的六边形栅格地图,采用A*算法初步确定AUV航行路径;
(3)以不碰撞障碍物为原则简化路径;
(4)为消除简化路径中的尖锐转角,采用三次样条插值方法对路径进行平滑处理。
2.根据权利要求1所述的一种基于六边形栅格地图的多AUV任务分配与路径规划方法,其特征在于,所述步骤(1)包括以下步骤:(11)以任务目标的位置坐标作为输入层,各AUV的位置坐标作为输出层;
(12)算出输入层坐标与输出层各坐标之间的欧氏距离并进行比较,根据最短距离选择获胜神经元,进行任务分配。
3.根据权利要求1所述的一种基于六边形栅格地图的多AUV任务分配与路径规划方法,其特征在于,所述步骤(2)包括以下步骤:(21)用栅格法构建六边形环境地图;
(22)引入成本估算函数:
F=G+H (4)
其中,G为从起点到指定网格的移动代价,H为从指定网格到终点的估算成本,F即为总的估算成本;
(23)遍历栅格地图,选择总估算成本最小的网格作为AUV下一步的目标位置。
4.根据权利要求1所述的一种基于六边形栅格地图的多AUV任务分配与路径规划方法,其特征在于,所述步骤(3)包括以下步骤:(31)选取A*算法生成路径的起始栅格,以连接线不碰撞障碍物为原则连接距离起始栅格最远的路径栅格,此即为简化的第一段路径;
(32)从简化的第一段路径的终点开始,以同样的方法画出第二段简化的路径,以此类推,完成全部路径的简化。
5.根据权利要求1所述的一种基于六边形栅格地图的多AUV任务分配与路径规划方法,其特征在于,所述步骤(4)实现过程如下:经过所有的转折点构建一个在所有转折点处左右两边连续,且二阶导数与一阶导数皆连续的函数:其中,xn即为第n个转折点;
设在每一个转折点处,S(x)的二阶导数为M:S”(xj)=Mj(j=0,1,…,n) (6)由Lagrange插值公式得:
其中,xj即为第j个转折点,hj为第j个区间的长度;
设第j个转折点的函数值为yj,由二阶导数连续即可化简得:再由一阶导数连续即可解得M值,从而确定插值函数,此插值函数的曲线即为最终所需的平滑后的优化路径。