[发明专利]机器人行走路线规划方法、程序及存储介质在审
申请号: | 202011619748.1 | 申请日: | 2020-12-30 |
公开(公告)号: | CN112762940A | 公开(公告)日: | 2021-05-07 |
发明(设计)人: | 施奕波 | 申请(专利权)人: | 浙江德源智能科技股份有限公司 |
主分类号: | G01C21/20 | 分类号: | G01C21/20;G06K9/38 |
代理公司: | 北京国翰知识产权代理事务所(普通合伙) 11696 | 代理人: | 叶帅东 |
地址: | 310051 浙江省杭州*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 行走 路线 规划 方法 程序 存储 介质 | ||
本发明公开了机器人行走路线规划方法、程序及存储介质,先通过获取场景的RGB图像T的信息,然后将图像T转换为灰度图像A;在输入并获得大小为M×N的灰度图像A后,采用Renyi熵的改进算法对图像A进行二值化,获得最佳阈值,使得图像A的熵值HA最大,得到二值化图像B;对二值化图像B进行边界搜索获得原始边界,将得到的原始边界进行多边形化处理,得到场景中障碍物的扩展区域多边形界限;逐一识别扩展区域多边形界限的每一个外凸角的顶点,并以顶点形成安全拟合曲线;以安全拟合曲线为参考边界,规划机器人的行走路线。因而本发明有行走效率高、侧向冲击小、识别边界准确、容差性能好的优点。
技术领域
本发明涉及机器人智能规划路线策略领域,尤其涉及机器人行走路线规划方法、程序及存储介质。
背景技术
二维平面的多机器人路径规划技术已经取得了丰硕的成果并得到了广泛的应用。在现有的多移动机器人系统路径规划技术研究中,基本上是针对移动机器人在地面上行驶可能会发生的冲突而提出的二维平面路径规划解决方法。现有技术如公告号为CN102929279B的中国发明专利公开了一种机器人路径规划方法,其技术特点是包括调度服务器内的主线程和并行执行的规划线程、避碰线程和执行线程,主线程初始化一张三维立体网状路径图并实时更新,规划线程划分任务、任务路径、标记任务路径并送入执行队列,避碰线程划分冲突区,并执行命令前的命令转义任务,执行线程向移动机器人或电梯机器人发送执行命令。该发明通过不同种类机器人接力操作、共同完成该任务行走路线的方法,实现了移动机器人和电梯机器人自动切换并且跨楼层任意存取货物的需求,具有高效率、合理性、实时性等特点。
发明内容
本发明的目的在于针对现有技术提供一种行走效率高、侧向冲击小、识别边界准确、容差性能好的机器人行走路线规划方法、程序及存储介质。
本发明解决上述技术问题所采用的技术方案为:机器人行走路线规划方法,通过获取场景的RGB图像T的信息,将图像T转换为灰度图像A;在输入并获得大小为M×N的灰度图像A后,采用Renyi熵的改进算法对图像A进行二值化,获得最佳阈值,使得图像A的熵值HA最大,得到二值化图像B;对二值化图像B进行边界搜索获得原始边界,将得到的原始边界进行多边形化处理,得到场景中障碍物的扩展区域多边形界限;逐一识别扩展区域多边形界限的每一个外凸角的顶点,并以顶点形成安全拟合曲线;以安全拟合曲线为参考边界,规划机器人的行走路线。通过采用新的二值化算法,先简化后优化障碍物的外轮廓边界,从而划分出更为光滑的路径可实施空间。通过新的行走路径逻辑,将行走时的横向冲击降低,防止运输物体侧滑,且经过优化的外轮廓边界光滑且大于障碍物轮廓,因而能杜绝行走卡在障碍物之间的情况发生。
为优化上述技术方案,采取的措施还包括:Renyi熵的改进算法获得最佳阈值的算法为:
其中,L为灰度级数,(t*(α),s*(α))为最佳阈值,(t,s)为二维矢量;为背景的Renyi熵,为障碍物体的Renyi熵;ε为修正系数,用于屏蔽阴影影响。通常情况采用Renyi熵能解决人的感官对于二值化后图像的识别舒适性问题,但采用一般方式产生的二值化图像不能用于机器人行程规划,需要进一步去噪。引入修正系数ε给整个算是引入了修正因素。
计算方式如下:
其中,p(i,j)为共生概率。ε的取值为其中,R,G,B代表图像T该点的红、绿、蓝色的RGB值。通过彩色图像中的信息缩小图形的外涂轮廓边界,使后处理的多边形包围算法产生的锐角数量减少,能更真实的反应可以通过机器人的区域。
多边形化处理为:采用扫描线算法包围二值化图像B的原始边界,得到多边形界限;将多边形界限外扩移动机器人的半径距离,得到扩展区域多边形界限。多边形界限外扩后,机器人可以简化为一个点,可以节省比较半径距离的算力。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江德源智能科技股份有限公司,未经浙江德源智能科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011619748.1/2.html,转载请声明来源钻瓜专利网。