一种机器人导航定位系统及方法
基本信息
申请号 | CN201711420969.4 | 申请日 | - |
公开(公告)号 | CN109959377A | 公开(公告)日 | 2019-07-02 |
申请公布号 | CN109959377A | 申请公布日 | 2019-07-02 |
分类号 | G01C21/20(2006.01)I; G05D1/02(2006.01)I | 分类 | 测量;测试; |
发明人 | 刘彤; 李占军; 林震岳 | 申请(专利权)人 | 北京东方兴华科技发展有限责任公司 |
代理机构 | 北京律诚同业知识产权代理有限公司 | 代理人 | 梁挥;林媛媛 |
地址 | 100086 北京市海淀区中关村南大街2号数码大厦B座802A/C | ||
法律状态 | - |
摘要
摘要 | 本发明公开一种机器人导航定位系统及方法,用于一机器人进行地图构建、定位以及路径规划,其方法包括如下步骤:S100,定位步骤:机器人通过多个传感器检测周围环境信息,而后基于自适应粒子滤波的SLAM算法,并匹配不同的里程计完成实时地图构建与定位;以及S200,路径规划步骤:采用基于双相混合状态A*的路径规划算法,包括:S210,在栅格化的地图上进行路径规划得到路径长度和扩展节点数后,通过解析扩展获得更高栅格化的地图;以及S220,将获得的路径长度和扩展节点数作为模糊推理的输入,经过模糊推理得到启发式权重,作为第二阶段的搜索的输入,在更高栅格化的地图上进行路径规划。本发明不仅能够适应于不同环境,且能够动态路径规划。 |
