[发明专利]一种自主避障路径规划方法、装置、设备及存储介质在审
申请号: | 202111435324.4 | 申请日: | 2021-11-29 |
公开(公告)号: | CN113985894A | 公开(公告)日: | 2022-01-28 |
发明(设计)人: | 郭君斌;于传强;李游;杜文正;李若亭;王俊提;孙晓艳 | 申请(专利权)人: | 中国人民解放军火箭军工程大学 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 武汉智嘉联合知识产权代理事务所(普通合伙) 42231 | 代理人: | 黄君军 |
地址: | 710025 *** | 国省代码: | 陕西;61 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 自主 路径 规划 方法 装置 设备 存储 介质 | ||
1.一种自主避障路径规划方法,应用于移动机器人,其特征在于,包括:
根据移动机器人周围环境的点云数据与目标区域栅格地图,得到目标区域的场景栅格地图;
根据所述目标区域的场景栅格地图,划分多个拟行走区域,并计算每个所述拟行走区域的概率路径矢量;
根据每个所述拟行走区域的概率路径矢量,选择移动机器人的无障碍移动路径;
根据所述无障碍初始移动路径,探索所述目标区域,直至对所述目标区域的探索达到预设要求。
2.根据权利要求1所述的自主避障路径规划方法,其特征在于,所述根据移动机器人周围环境的点云数据与目标区域栅格地图,得到目标区域的场景栅格地图,包括:
将移动机器人的探索区域设置为目标区域,获取移动机器人周围环境的点云数据;
根据预设算法以及所述移动机器人周围环境的点云数据构建移动机器人周围环境的三维点云地图;
根据目标区域构建目标区域栅格地图;
将所述三维点云地图与目标区域栅格地图进行映射,得到目标区域的场景栅格地图。
3.根据权利要求2所述的自主避障路径规划方法,其特征在于,所述目标区域的场景栅格地图分为灰、白、黑三个部分,其中,灰色部分为目标区域内无激光点扫描的区域,该像素点赋值为-1;白色部分为在目标区域内激光点扫描无障碍的部分,该像素点赋值为0;黑色部分为在目标区域内激光点扫描有障碍的部分,像素点赋值为100。
4.根据权利要求1所述的自主避障路径规划方法,其特征在于,所述拟行走区域的中心包含一条路径射线,所述根据所述目标区域的场景栅格地图,划分多个拟行走区域,并计算每个所述拟行走区域的概率路径矢量,包括:
以移动机器人为中心,根据所述目标区域的场景栅格地图,划分多个拟行走区域;
根据所述目标区域的场景栅格地图,计算每个所述拟行走区域的路径射线的概率路径矢量。
5.根据权利要求3所述的自主避障路径规划方法,其特征在于,所述根据每个所述拟行走区域的概率路径矢量,选择移动机器人的无障碍移动路径,包括:
根据每个所述拟行走区域的路径射线的概率路径矢量,计算每个拟行走区域的可达值;
根据所述每个拟行走区域的可达值,得到可达值最大的拟行走区域,即为初始路径区域;
根据所述初始路径区域,选择移动机器人的无障碍移动路径。
6.根据权利要求5所述的自主避障路径规划方法,其特征在于,所述根据所述初始路径区域,选择移动机器人的无障碍移动路径,包括:
根据所述初始路径区域内的概率路径矢量,规避像素点赋值为100的区域,得到无障碍的初始路径区域;
根据所述无障碍的初始路径区域,选择像素点赋值为-1的最长概率路径,即为移动机器人的无障碍移动路径。
7.根据权利要求1所述的自主避障路径规划方法,其特征在于,所述根据所述无障碍初始移动路径,探索所述目标区域,直至对所述目标区域的探索达到预设要求,包括:
移动机器人按照所述无障碍移动路径移动,每次移动都更新所述目标区域的场景栅格地图;
计算所述更新后的目标区域的场景栅格地图中灰色区域的占比;
当所述灰色区域的占比高于预设要求时,根据所述更新后的目标区域的场景栅格地图重新规划无障碍移动路径,直至所述灰色区域的占比低于预设要求,即完成目标区域的避障路径规划。
8.一种自主避障路径规划装置,应用于一种移动机器人,其特征在于,包括:
建图模块,用于根据移动机器人周围环境的点云数据与目标区域栅格地图,得到目标区域的场景栅格地图;
计算模块,用于根据所述目标区域的场景栅格地图,划分多个拟行走区域,并计算所述多个拟行走区域的概率路径矢量;
规划模块,用于根据所述多个拟行走区域的概率路径矢量,选择移动机器人的无障碍移动路径;
探索模块,用于根据所述无障碍初始移动路径,探索所述目标区域,直至对所述目标区域的探索达到预设要求。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国人民解放军火箭军工程大学,未经中国人民解放军火箭军工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111435324.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种保坍型聚羧酸减水剂及其制备方法
- 下一篇:一种J型线夹安装装置及安装方法