用仿射对应关系求解已知竖直方向的广义相对位姿,实现全局最优
Globally Optimal Solution to the Generalized Relative Pose Estimation Problem using Affine Correspondences
- 通过解耦旋转与平移,建立基于仿射对应关系的代数误差代价函数
- 将全局优化转化为双未知数多项式方程组,精确求解旋转角与平移向量
- 适用于多摄像头+IMU系统,尤其在小角度旋转时有更优精度
配备多摄像头系统和惯性测量单元(IMU)的移动设备广泛应用,如自动驾驶汽车。利用视觉与惯性信息进行相对位姿估计在多个领域具有重要意义。为提升多摄像头系统的相对位姿估计精度,本文提出一种基于仿射对应关系的全局最优求解器,用于在已知竖直方向条件下估计广义相对位姿。首先,在解耦旋转矩阵与平移向量后,建立关于相对旋转角的代价函数,最小化仿射对应关系带来的几何约束代数误差。随后,基于特征方程及其一阶导数为零的条件,将全局优化问题转化为两个未知数的多项式方程组。最终,通过多项式特征值求解器获得相对旋转角,平移向量由特征向量确定。此外,当相对旋转较小时,提出一种新的线性解法。所提方法在合成数据与真实数据集上进行了评估,实验结果表明其在精度上优于现有先进方法。
原文摘要 · Abstract (English)
Mobile devices equipped with a multi-camera system and an inertial measurement unit (IMU) are widely used nowadays, such as self-driving cars. The task of relative pose estimation using visual and inertial information has important applications in various fields. To improve the accuracy of relative pose estimation of multi-camera systems, we propose a globally optimal solver using affine correspondences to estimate the generalized relative pose with a known vertical direction. First, a cost function about the relative rotation angle is established after decoupling the rotation matrix and translation vector, which minimizes the algebraic error of geometric constraints from affine correspondences. Then, the global optimization problem is converted into two polynomials with two unknowns based on the characteristic equation and its first derivative is zero. Finally, the relative rotation angle can be solved using the polynomial eigenvalue solver, and the translation vector can be obtained from the eigenvector. Besides, a new linear solution is proposed when the relative rotation is small. The proposed solver is evaluated on synthetic data and real-world datasets. The experiment results demonstrate that our method outperforms comparable state-of-the-art methods in accuracy.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。