有限视角重叠和不准确外参标定下的多相机SLAM的鲁棒初始化

1. 摘要

本文提出了一种当相机只有有限的公共视野和不准确的外参标定情形下的用于多相机视觉SLAM系统的鲁棒初始化方法。有限的共同视野导致只有一些特征可以在相机之间匹配上。离线标定后,由于振动或相机错误放置而导致的不准确的外部位姿,使得三角化种子3D点以成功初始化SLAM系统变得更加困难。没有像大多数多相机系统那样将外参设为定值以用于特征匹配和3D点三角化,我们提出将不准确的外参作为软约束来适应标定误差。我们的初始化方法包括在不同相机之间匹配和在两个关键帧之间匹配两个阶段。这两个阶段都涉及优化包含来自不准确标定参数的外参位姿先验的代价函数。通过合并这些软位姿约束,我们可以在避免由不准确外参参数造成的错误的特征匹配和三角测量的同时,保持仅存在少数特征对应时的解空间。实际测试的结果表明,即使离线标定的位姿先验和真实值差异较大,这样一个简单的解决方案也可以显著提高SLAM初始化的成功率。

图1.  左图:我们的多摄像头SLAM系统部署所在的自动驾驶汽车。红色圆圈表示相机位置。右: 四台摄像机的快照。请注意相邻的摄像机之间的共同视场角只有大约20度。
图2 .当多相机装备从关键帧1移动到关键帧2时,不同坐标系之间的关系。我们使用质数符号代表第二帧中的坐标系。
图3. 极线可视化。(a) :没有位姿先验时匹配点(绿色)的结果。(b) :具有位姿先验的结果。注意没有匹配上的点(红色)远离其对应的在(a)中的极线,表示从这些特征点中没有很好地提取相对位姿。
图4. 左上角:用于定量评估的迷你车,其中红色圆圈表示具有狭窄公共视场角的四个摄像机。相机之间的基线约为36厘米。右上角:地面真实位姿(蓝色)的可视化、不准确位姿先验(红色)和通过我们的方法(绿色)估计的位姿。底部:街道场景、动态场景和狭窄场景测试序列的采样图片。
表1. 两阶段初始化的消融研究。更多细节见第V-A节。
表2.两种基准方法的对比。
图5.我们的方法应用于一个真实的驾驶案例。地图和相机位姿显示在顶部,不同的颜色表示不同相机,破折号代表关键帧(请放大查看详细信息)。图像和特征点显示在底部。
图6.通过添加不同级别的相对真值的旋转和平移噪声得到RMSE分布。当扰动在旋转上小于10度在平移上小于10厘米时,在线外参细化能获得可靠结果。
表3.三种场景下初始化方法的成功率。
表4.在三种道路条件下在线外参标定的定量评估。三种道路条件下的所有RMSE都非常小。更多详细信息参见第V-B节。

猜你喜欢

转载自blog.csdn.net/xhtchina/article/details/128751237