[发明专利]一种机器人导航方法有效
申请号: | 201611086145.3 | 申请日: | 2016-12-01 |
公开(公告)号: | CN106774310B | 公开(公告)日: | 2019-11-19 |
发明(设计)人: | 熊毅;朱璇;朱波;任振军 | 申请(专利权)人: | 中科金睛视觉科技(北京)有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 11416 北京律恒立业知识产权代理事务所(特殊普通合伙) | 代理人: | 顾珊;庞立岩<国际申请>=<国际公布>= |
地址: | 100191 北京市海*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明提供了一种机器人导航方法,所述导航方法包括如下步骤:a、建立所述机器人工作区域的导航栅格地图,将所述导航栅格地图导入所述机器人的操作系统;b、对所述机器人的起始位置和所述机器人行进的目标终点进行定位,规划机器人行进路径,所述机器人按所述路径前进;c、当步骤b中所述路径出现障碍,获取所述机器人实时位姿信息,根据所述实时位姿信息和所述目标终点的位置信息对所述机器人行进路径进行实时路径规划,其中在计算所述机器人当前位置代价函数的实际代价中引入方向改变代价,计算所述机器人当前位置不同方向的代价;d、搜索所述机器人当前位置不同方向的代价,选择代价最小的方向前进。 | ||
搜索关键词: | 一种 机器人 导航 方法 | ||
【主权项】:
1.一种机器人导航方法,所述导航方法包括如下步骤:a、建立所述机器人工作区域的导航栅格地图,将所述导航栅格导入所述机器人的操作系统;/nb、对所述机器人的起始位置和所述机器人行进的目标终点进行定位,规划机器人行进路径,所述机器人按所述路径前进;/n其特征在于,所述导航方法还包括:/nc、当步骤b中所述路径出现障碍,获取所述机器人实时位姿信息,根据所述实时位姿信息和所述目标终点的位置信息对所述机器人行进路径进行实时路径规划,其中/n所述实时路径规划过程中,在计算机器人代价函数的实际代价中引入方向改变代价,计算所述机器人当前位置不同方向的代价;/n所述机器人代价函数定义为:/nf(i)=g(i)+h(i),其中,/ng(i)为机器人起点到当前位置i付出的实际代价,h(i)为启发函数,即当前位置到目标终点的最小代价的估计;/n所述实际代价满足:g(i)=d(i)+m(i),其中,d(i)为方向改变代价,m(i)为直线行进代价;/n方向改变代价d(i)为机器人从当前位置的栅格移动至外围栅格,改变方向的代价,直线行进代价m(i)为机器人从当前位置的栅格移动至外围栅格,行进直线距离产生的代价;/nd、搜索所述机器人当前位置不同方向的代价,所述机器人选择代价最小的方向前进;/n当机器人进行至下一栅格时,如果方向发生改变,在改变方向的基础上,重新通过代价函数f(i)对当前位置代价计算,重新规划行进路径。/n
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中科金睛视觉科技(北京)有限公司,未经中科金睛视觉科技(北京)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201611086145.3/,转载请声明来源钻瓜专利网。