- 专利标题: 一种基于Apriltag标签与因子图的SLAM方法
-
申请号: CN202010017116.1申请日: 2020-01-08
-
公开(公告)号: CN111242996B公开(公告)日: 2021-03-16
- 发明人: 郭轩 , 程楠
- 申请人: 郭轩
- 申请人地址: 河南省新乡市红旗区人民东路538号名苑小区22号楼西3单元3层
- 专利权人: 郭轩
- 当前专利权人: 河南笛卡尔机器人科技有限公司
- 当前专利权人地址: 河南省新乡市红旗区人民东路538号名苑小区22号楼西3单元3层
- 代理机构: 新乡市平原智汇知识产权代理事务所
- 代理商 林海
- 主分类号: G06T7/50
- IPC分类号: G06T7/50 ; G06T7/73 ; G01C21/20
摘要:
本发明提供了一种基于Apriltag标签与因子图的SLAM方法,包括:首先读取预设数据并构建坐标系;以预设数据为因子,初始化因子图;使用相机采集标签图像;利用相机标定畸变参数对标签图像进行预处理;提取Apriltag标签角点与ID;以Apriltag标签角点的图像坐标值为映射因子更新因子图;判断是否提供相机载体的里程计(Odom);采集载体里程计数据;以载体里程计数据为相对位姿因子更新因子图;优化因子图,计算物体,Apriltag标签,载体,相机的位姿,最后更新地图。利用本发明能够提供高精度的载体位姿数据,并构建高精度的地图信息。
公开/授权文献
- CN111242996A 一种基于Apriltag标签与因子图的SLAM方法 公开/授权日:2020-06-05