机器人的室内定位方法及装置

基本信息

申请号 CN202110342844.4 申请日 -
公开(公告)号 CN113091743A 公开(公告)日 2021-07-09
申请公布号 CN113091743A 申请公布日 2021-07-09
分类号 G01C21/20(2006.01)I;G06F17/16(2006.01)I 分类 测量;测试;
发明人 刘星;韩松杉;张弥 申请(专利权)人 浙江欣奕华智能科技有限公司
代理机构 北京同达信恒知识产权代理有限公司 代理人 杨晓萍
地址 314400浙江省嘉兴市海宁市海宁经济开发区隆兴路118号内主办公楼3楼
法律状态 -

摘要

摘要 本公开提供机器人的室内定位方法及装置。包括:当机器人的相机捕获到路标点,且路标点在加权地图中,则根据上一时刻所述机器人的实际位姿、所述机器人的角度增量以及所述机器人的位移增量确定机器人当前时刻的预测位姿;所述加权地图是基于卡尔曼滤波算法建立的;根据捕获到的所述路标点在所述加权地图中对应的协方差矩阵以及所述机器人的相机观测误差确定当前定位观测误差;利用所述当前定位观测误差、观测信息、所述路标点在加权地图中的位姿以及机器人的预测位姿进行卡尔曼滤波更新和卡尔曼滤波融合,得到机器人的实际位姿;由此,本公开除了考虑相机观测误差之外,还结合当前路标点在加权地图中的不确定性,提高了机器人的定位精度。