远洋集装箱船清洗的多机器人协同路径规划方法与流程

摘要: 本发明涉及路径规划,具体涉及远洋集装箱船清洗的多机器人协同路径规划方法。背景技术:1、远洋船舶在长期航行中,船体表面易附着海洋生物,不仅增大航行阻力、增加燃料消...
远洋集装箱船清洗的多机器人协同路径规划方法与流程

本发明涉及路径规划,具体涉及远洋集装箱船清洗的多机器人协同路径规划方法。

背景技术:

1、远洋船舶在长期航行中,船体表面易附着海洋生物,不仅增大航行阻力、增加燃料消耗,还会造成船体腐蚀。因此,及时清理船舶表面附着物对船舶航行的效率、安全性十分重要。

2、目前,常采用多水下机器人协同作业,通过预先规划的路径对船体表面进行高效清洁。然而,在清洗作业过程中,受洋流、海浪冲击以及船舶自身航行等复杂流体力学因素影响,水下清洗机器人极易受水流外力冲击而偏离预定的清洗轨道。针对该偏移问题,现有技术通常采用几何最短路径即脱离点与当前位置的连线控制机器人直线复位,以期尽快继续作业。然而,这种常规的直线回归策略忽略导致机器人偏离的根本诱因,即海浪与洋流等外部流场的强力冲击。在此情况下,强制沿几何最短路径复位往往意味着机器人需要直接对抗巨大的流场阻力,不仅会造成推进能耗剧增,还会因阻力过大导致复位极其缓慢。

技术实现思路

1、为了解决水下清洗机器人受水流外力偏离轨道后,常规最短直线回归策略因对抗流场阻力导致能耗过高且复位缓慢的技术问题,本发明的目的在于提供一种远洋集装箱船清洗的多机器人协同路径规划方法,所采用的技术方案具体如下:

2、本发明一个实施例提供了远洋集装箱船清洗的多机器人协同路径规划方法,该方法包括:

3、在远洋集装箱船表面的二维栅格地图上,为用于清洗远洋集装箱船的多个机器人分配工作区域及预定轨道;实时获取各机器人在清洗过程中的实际位置;

4、根据各机器人在当前时刻的预设分析时段内实际位置相对于其预定轨道的距离偏离程度与航向偏转程度,选取当前时刻的待复位机器人;

5、根据待复位机器人在当前时刻所处工作区域与其相邻工作区域的环境外力方向差异,以及相邻工作区域的环境外力对预定轨道的牵引趋势,选取待复位机器人在当前时刻的绕路备选区域;

6、根据待复位机器人进入各绕路备选区域的距离代价,以及对应绕路备选区域的环境外力对切入航向的顺应程度,从待复位机器人在当前时刻的绕路备选区域中选取最优绕行区域;

7、规划待复位机器人经由所述最优绕行区域至其预定轨道的归航路径,并控制待复位机器人沿所述归航路径移动。

8、进一步地,所述选取当前时刻的待复位机器人,包括:

9、将各机器人在每个时刻的实际位置到其预定轨道的最短距离记为偏轨距离;

10、对于每个机器人,若机器人在当前时刻的预设分析时段内各时刻的偏轨距离均大于预设容许偏离阈值,且在该预设分析时段的起始时刻的前一时刻的偏轨距离小于或者等于预设容许偏离阈值,则获取机器人在所述预设分析时段内各时刻的偏轨距离的一阶差分序列;

11、分别统计所述一阶差分序列中正值元素之和与负值元素的绝对值之和,依次记为离轨累积量与回轨累积量;将所述离轨累积量与所述回轨累积量的比值,作为机器人在当前时刻的净偏离趋势比;

12、根据机器人在当前时刻的预设分析时段的实际位移方向与理想位移方向的差异,获取机器人在当前时刻的航向吻合系数;

13、根据所述净偏离趋势比与所述航向吻合系数,获取机器人在当前时刻的综合偏轨指数;选取所述综合偏轨指数大于预设偏轨阈值的机器人作为当前时刻的待复位机器人。

14、进一步地,所述获取机器人在当前时刻的航向吻合系数,包括:

15、计算机器人在所述预设分析时段的理想移速与预设分析时段的时长的乘积作为预计位移量;将机器人的预定轨道上距离预设分析时段的起始时刻的实际位置最近的点的切线方向作为理想行进方向;从所述起始时刻的实际位置出发,沿所述理想行进方向延伸所述预计位移量,得到机器人在当前时刻的预计位置;

16、将从机器人在当前时刻的预设分析时段的起始时刻的实际位置,分别指向当前时刻的实际位置、预计位置的向量,依次记为实际位移向量、理想位移向量;并对所述实际位移向量与所述理想位移向量的余弦相似度进行归一化处理,得到机器人在当前时刻的航向吻合系数。

17、进一步地,所述选取待复位机器人在当前时刻的绕路备选区域,包括:

18、计算待复位机器人在当前时刻的预设分析时段的所述实际位移向量与所述理想位移向量的差向量,将该差向量与预设分析时段内时刻数的倒数进行数乘运算,得到待复位机器人在当前时刻所处工作区域的流体干扰向量;

19、对于待复位机器人在当前时刻所处工作区域的每个相邻工作区域,将从该相邻工作区域的中心点指向待复位机器人的预定轨道上距离所述中心点最近的点的向量,作为该相邻工作区域的轨道牵引向量;

20、若待复位机器人在当前时刻所处工作区域与其每个相邻工作区域的所述流体干扰向量的夹角为钝角,且该相邻工作区域的所述流体干扰向量与所述轨道牵引向量的点乘结果大于零,则将该相邻工作区域作为待复位机器人在当前时刻的绕路备选区域。

21、进一步地,所述从待复位机器人在当前时刻的绕路备选区域中选取最优绕行区域,包括:

22、对于待复位机器人在当前时刻的每个绕路备选区域,将从待复位机器人在当前时刻的实际位置指向该绕路备选区域的边界上距离所述实际位置最近的点的向量,作为该绕路备选区域的最短越界向量;

23、将待复位机器人在当前时刻的所述偏轨距离与其每个绕路备选区域的最短越界向量的模长的比值,作为该绕路备选区域的绕行代价收益比;

24、计算待复位机器人在当前时刻所处工作区域的所述流体干扰向量,分别与该时刻的每个绕路备选区域的所述流体干扰向量、最短越界向量之间的夹角,依次记为流场偏转角、越界航向偏角;

25、将所述流场偏转角的余弦值的相反数与常数1减去所述越界航向偏角的余弦值的差值进行比值运算,得到待复位机器人在当前时刻的每个绕路备选区域的流场顺应度;

26、根据待复位机器人在当前时刻的综合偏轨指数,以及该时刻的每个绕路备选区域的绕行代价收益比和流场顺应度,获取对应绕路备选区域的综合推荐度;

27、从待复位机器人在当前时刻的所有绕路备选区域中,选取综合推荐度大于预设推荐阈值且数值最大的绕路备选区域,作为该时刻的最优绕行区域。

28、进一步地,所述规划待复位机器人经由所述最优绕行区域至其预定轨道的归航路径,包括:

29、将待复位机器人的预定轨道上距离当前时刻的预设分析时段的起始时刻的实际位置最近的点,记为作业复位点;

30、以待复位机器人在当前时刻的实际位置为起点,以所述作业复位点为终点;将待复位机器人在当前时刻的所述最优绕行区域的边界上距离所述起点最近的点记为区域切入节点;采用蚁群算法规划从起点经所述区域切入节点至终点的路径,作为归航路径;

31、其中,将所述蚁群算法中的启发因子设定为迎流阻力代价的倒数;在执行蚁群算法进行相邻的栅格节点间的路径搜索时,计算从当前遍历的栅格节点指向待转移的相邻栅格节点的向量,将该向量与所述最优绕行区域的所述流体干扰向量之间的夹角作为转移流场偏角;对所述转移流场偏角的余弦值进行负相关映射,将映射结果与对应相邻的栅格节点间的距离的乘积设定为相邻的栅格节点间的所述迎流阻力代价。

32、进一步地,若待复位机器人在当前时刻的所有绕路备选区域的综合推荐度均小于或等于预设推荐阈值,则将待复位机器人在当前时刻的实际位置到所述作业复位点的直线作为归航路径。

33、进一步地,当所述最短越界向量为零向量,或者所述越界航向偏角的余弦值等于1时,将所述综合推荐度赋值为极限推荐度;其中,极限推荐度大于预设推荐阈值。

34、进一步地,所述净偏离趋势比与所述综合偏轨指数呈正相关,所述航向吻合系数与所述综合偏轨指数呈负相关。

35、进一步地,当前时刻位于其预设分析时段的结束时刻。

36、本发明具有如下有益效果:

37、在本发明实施例中,通过综合分析机器人在预设分析时段内实际位置相对于预定轨道的距离偏离程度与航向偏转程度,能够精准锁定因受水流外力影响而发生实质偏轨的待复位机器人;在面临偏轨复位时,通过对比当前时刻所处工作区域与相邻工作区域的环境外力方向差异,以及相邻工作区域的环境外力对预定轨道的牵引趋势,寻找出能够提供反转水流并助力机器人向轨道靠拢的绕路备选区域;在此基础上,进一步综合分析进入各绕路备选区域的空间距离代价以及环境外力对切入航向的顺应程度,精准锁定前置物理消耗最小、跨区逆水阻力最低的最优绕行区域,并据此规划最终的归航路径。本方案将导致机器人偏轨的环境外力巧妙地由阻力转化为推力,有效解决水下清洗机器人受水流外力偏离轨道后,采用常规最短直线回归策略因强行对抗流场阻力导致推进能耗过高且复位缓慢的技术问题,显著提升机器人回归预定轨道的复位效率与水下作业的整体续航能力。