买专利卖专利找龙图腾,真高效! 查专利查商标用IPTOP,全免费!专利年费监控用IP管家,真方便!
申请/专利权人:南京理工大学
摘要:本发明公开了一种AprilTag检测辅助的激光雷达建图与定位方法。该方法首先通过IMU数据估计重力方向,并结合IMU和里程计数据估计机器人初始位姿;根据重力方向将激光雷达点云数据投影到2D世界,并根据初始位姿在当前栅格子地图下进行局部扫描匹配;对相机数据进行去畸变,并在机器人位姿接近预先设定的固定点位时进行AprilTag检测,以获取机器人的精确位姿;同时,使用投影后的点云数据,对所有栅格子地图定期执行闭环检测以获取机器人精确位姿;根据AprilTag检测或闭环检测结果,每当有新的精确位姿时进行位姿优化;根据局部扫描匹配结果或位姿优化结果更新栅格子地图,当子地图的数据容量达到上限时生成新的子地图,并利用各子地图坐标系间的位姿关系构建全局地图。本发明通过相机AprilTag检测和闭环检测,修正了激光雷达建图与定位过程中的累积误差,显著提高定位系统的精度和鲁棒性,实时性高,适用于各种机器人和自动化系统的导航与定位。
主权项:1.一种AprilTag检测辅助的激光雷达建图与定位方法,其特征在于,包括以下步骤:第一步,采集原始数据,包括IMU和里程计数据、激光雷达点云数据、相机数据;第二步,通过IMU数据估计重力方向,并结合IMU和里程计数据估计机器人初始位姿,根据重力方向将激光雷达点云数据投影到2D世界,并根据初始位姿在当前栅格子地图下进行局部扫描匹配;处理相机数据,对相机视频流中的图像进行去畸变操作;第三步,当机器人位姿接近预先设定的固定点位时进行AprilTag检测,以获取机器人的精确位姿;同时使用投影后的点云数据,对所有栅格子地图定期执行闭环检测以获取机器人精确位姿;第四步,根据AprilTag检测或闭环检测结果,每当有新的精确位姿时进行位姿优化;第五步,根据局部扫描匹配结果或位姿优化结果更新栅格子地图,当子地图的数据容量达到上限时生成新的子地图,并利用各子地图坐标系间的位姿关系构建全局地图。
全文数据:
权利要求:
百度查询: 南京理工大学 AprilTag检测辅助的激光雷达建图与定位方法
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。