申请/专利权人：浙江工业大学

申请日：2021-07-21

公开（公告）日：2023-12-26

公开（公告）号：CN113741416B

主分类号：G05D1/02

分类号：G05D1/02

优先权：

专利状态码：有效-授权

法律状态：2023.12.26#授权;2021.12.21#实质审查的生效;2021.12.03#公开

摘要：一种基于改进捕食者猎物模型和DMPC的多机器人全覆盖路径规划方法，输入地图空间，机器人位置和运动优先级等信息；对地图空间栅格化，并赋予栅格状态属性；随机生成初始参数种群和种群数量；根据周围栅格状态，确定机器人运动模型；进入死区时，利用A*回溯脱离；未进入死区，根据激励函数找到周围激励最大的栅格并移动；引入DMPC方法，根据运动模型，预测机器人的移动序列；利用WOA对参数优化求解寻找最佳的移动序列；通过不断的滚动决策，实现地图的全覆盖。本发明能够得到路径重复率低，总路径长度短的全覆盖路径。

主权项：1.一种基于改进捕食者猎物模型和DMPC的多机器人全覆盖路径规划方法，其特征在于，所述方法包括下列步骤：步骤1：输入地图空间，多机器人的初始位置，机器人的探测半径和机器人的运动速度，机器人运动的优先级；步骤2：对地图空间栅格化，使得机器人能刚好覆盖一个栅格，并对每个栅格赋予不同的状态属性，将多机器人系统划分为多个子系统，栅格的状态属性Ix,y和机器人覆盖的任务空间WS分别为： WS＝{x,y|Ix,y＝1,0＜x＜x_l,0＜y＜y_l}2式中x_l，y_l分别为地图空间离散后x轴的长度和y轴的长度；步骤3：随机生成初始参数种群种群数量为pop；步骤4：机器人根据传感器检测到的信息，确定周围栅格的状态属性，从而判断机器人是否陷入死区，确定机器人的运动模型，若陷入死区跳转至步骤5，若为陷入死区跳转至步骤7；步骤5：从回溯列表中剔除其他回溯点半径r内的栅格坐标，得到搜索列表Lsearch为：Lsearch＝LreturnLback,r3式中Lreturn代表回溯列表，Lback,r代表回溯点半径r内的点的集合；步骤6：从搜索列表中找到距离当前机器人最近的自由栅格坐标，使用A*算法脱离死区，得到机器人的移动序列后跳转至步骤10，机器人的移动序列Apath为：Apath＝{A1,A2,…Ai,…Preturn}4式中Ai为A*算法规划出的路径点坐标，Preturn为回溯点坐标；步骤7：根据改进后的捕食者猎物模型计算机器人临近点未覆盖栅格的各激励值大小，计算避开竞争者激励Ecompete为： 式中D代表两栅格之间的欧式距离，Okt,j代表机器人k在t时刻的临近点j的位置，H代表机器人k通讯范围Hmax内其他机器人的个数，Rk,i，Rk,m分别代表通讯范围内的第i，m个机器人位置；步骤8：计算移动方向激励Edirection为： ∠Ok,t-1Ok,tOkt,j＝|atan2yk,j-yk,t,xk,j-xk,t-atan2yk,t-yk,t-1,xk,t-xk,t-1|7式中∠Ok,t-1Ok,tOkt,j为机器人当前移动方向于下一步移动方向之间的夹角，xk,t-1,yk,t-1，xk,t,yk,t，xk,j,yk,j分别为机器人k前一时刻，当前时刻和下一时刻的坐标位置；步骤9：计算边界激励Eb为： nNOkt,j代表在机器人k的临近点j处未覆盖的栅格数量，代表允许的临近点最大个数；步骤10：计算栅格总激励值E为：EOkt,j＝ωcEcompeteOkt,j+ωsEdirectionOkt,j+EbOkt,j9式中ωc，ωs为权重因子；步骤11：机器人根据最大激励或者脱离死区序列决定机器人下一步移动坐标，当多个机器人在相同时刻选择同一栅格时，优先级高的机器人优先运动，机器人下一步移动坐标为stepk,t*： 步骤12：引入DMPC方法，根据步骤4-11预测机器人T步路径序列，以覆盖自由栅格数和路径长度为指标，设立评价函数，预测序列ykt和评价函数分别JT为：ykt＝[ykt+1|t,ykt+2|t,…ykt+T|t]11 式中Ncover代表机器人覆盖的栅格数，L代表路径长度，α，β表示权重系数；步骤13：通过WOA优化ωs，迭代次数WOAiter，以机器人T步的评价函数作为适应度函数，得到机器人未来T步的最佳移动序列LT：LT＝{Stepk,t+1,…Stepk,t+i,…Stepk,t+T}13其中Stepk,t+i代表机器人k在t+i时刻的位置，i＝1,2…T；步骤14：机器人选择移动序列中最靠前的序列并移动，同时更新栅格地图状态和机器人位置，并将未覆盖的栅格信息加入回溯列表中，删除已覆盖的栅格点；步骤15：当前迭代次数iter达到最大迭代次数itermax或时，执行步骤16；否则，iter＝iter+1，返回步骤3；步骤16：输出路径，结束。

全文数据：

权利要求：

百度查询： 浙江工业大学 基于改进捕食者猎物模型和DMPC的多机器人全覆盖路径规划方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD