融合ArUco码先验信息的SLAM累计误差消除算法
作者:刘贵涛; 张雷; 徐方
更新时间:
在移动机器人,在无环场景中通过双目视觉传感器估计姿势时,累积误差无法消除一个问题。为了解决这一问题,提出了一套利用aruco码的先验信息辅助消除累积误差的算法。该算法由三部分组成:ArUco编码检测、摄像机姿态估计和累积误差消除。首先,通过阈值、四边形检测和亚像素优化等图像处理方法检测ArUco码在图像中的位置。其次,通过PNP算法和先验的aruco码信息估计当前帧中摄像机的姿态。最后,构建了一个携带先验阿鲁科码信息的图模型,并在Levenberg-Marquardt算法迭代对该图模型进行了优化,以消除SLAM体系的累积误差。实验结果表明,该算法能有效消除双目视觉传感器姿态估计的峰值,满足机器人实时定位的要求。