一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

移动机器人路径规划方法、装置、计算机设备和存储介质与流程

2022-02-20 13:48:24 来源:中国专利 TAG:

技术特征:
1.移动机器人路径规划方法,其特征在于,包括以下步骤:制作起始点和目标点之间的连线,所述起始点和目标点分别为第一节点和第二节点;选择在所述连线上的点作为第三节点;每两个相邻节点之间采用双向快速随机搜索树算法进行路径规划。2.根据权利要求1所述的移动机器人路径规划方法,其特征在于,当所述连线的中点不存在障碍物,所述第三节点为所述连线的中点;当所述连线的中点存在障碍物,所述第三节点为所述连线上靠近中点且不存在障碍物的点。3.根据权利要求2所述的移动机器人路径规划方法,其特征在于,设定所述连线的长度为l,第三节点与所述中点的距离不大于l/4。4.根据权利要求3所述的移动机器人路径规划方法,其特征在于,当所述连线的中点存在障碍物,选择距离中点l/2n的距离点作为第三节点,n为不小于2的自然数,并以n逐渐增加的方式进行选择。5.根据权利要求1所述的移动机器人路径规划方法,其特征在于,所述双向快速随机搜索树算法采用目标偏向策略生成新的节点,所述目标偏向策略为:由搜索树的当前点n
nearest
通过连接新节点n
new
朝向搜索树的目标点x
end
不断扩展延伸;所述当前点n
nearest
与目标点x
end
之间的连线与横轴形成的角度用以修正确定新节点n
new
的位置。6.根据权利要求5所述的移动机器人路径规划方法,其特征在于,所述新节点n
new
满足以下公式确定:x=n
nearest
(x) dcosθ kcosα (1-k)sinα;y=n
nearest
(y) dsinθ ksinα (1-k)cosα;其中:(x,y)为新节点n
new
的坐标;n
nearest
(x)为当前点n
nearest
的横坐标;n
nearest
(y)为当前点n
nearest
的纵坐标;n
rand
为快速随机搜索树算法的随机采样点;d为n
rand
与n
nearest
的两点间距与固定步长e的相对较小值;θ为采样点n
rand
与当前点n
nearest
之间的连线与横轴形成的角度;α为当前点n
nearest
与目标点x
end
之间的连线与横轴所形成的角度;k为常数。7.根据权利要求5所述的移动机器人路径规划方法,其特征在于,扩展时,任意一棵搜索树以另一棵搜索树的当前点n
nearest
作为目标点x
end
,当其中一棵搜索树遇到障碍物时,扩展另一棵搜索树。8.移动机器人路径规划装置,其特征在于,包括:第一模块,用于制作起始点和目标点之间的连线,所述起始点和目标点分别为第一节点和第二节点;第二模块,用于选择在所述连线上的点作为第三节点;第三模块,用于每两个相邻节点之间采用双向快速随机搜索树算法进行路径规划。
9.计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至7中任一项所述移动机器人路径规划方法的步骤。10.计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至7中任一项所述移动机器人路径规划方法的步骤。

技术总结
本申请公开了一种移动机器人路径规划方法、装置、计算机设备和存储介质,所述移动机器人路径规划方法包括:制作起始点和目标点之间的连线,所述起始点和目标点分别为第一节点和第二节点;选择在所述连线上的点作为第三节点;每两个相邻节点之间采用双向快速随机搜索树算法进行路径规划。本申请保证第三节点处于起始点和目标点之间的连线上,在避免了路径曲折的同时提高了计算效率;通过目标偏向策略,避免了新节点N


技术研发人员:赵芸 陈家贵 徐兴
受保护的技术使用者:浙江科技学院
技术研发日:2021.07.22
技术公布日:2022/1/14
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献