AUTHOR=Liu Haotian , Chen Guang , Liu Yinlong , Liang Zichen , Zhang Ruiqi , Knoll Alois TITLE=Globally-Optimal Inlier Maximization for Relative Pose Estimation Under Planar Motion JOURNAL=Frontiers in Neurorobotics VOLUME=16 YEAR=2022 URL=https://www.frontiersin.org/journals/neurorobotics/articles/10.3389/fnbot.2022.820703 DOI=10.3389/fnbot.2022.820703 ISSN=1662-5218 ABSTRACT=
Planar motion constraint occurs in visual odometry (VO) and SLAM for Automated Guided Vehicles (AGVs) or mobile robots in general. Conventionally, two-point solvers can be nested to RANdom SAmple Consensus to reject outliers in real data, but the performance descends when the ratio of outliers goes high. This study proposes a globally-optimal Branch-and-Bound (BnB) solver for relative pose estimation under general planar motion, which aims to figure out the globally-optimal solution even under a quite noisy environment. Through reasonable modification of the motion equation, we decouple the relative pose into relative rotation and translation so that a simplified bounding strategy can be applied. It enhances the efficiency of the BnB technique. Experimental results support the global optimality and demonstrate that the proposed method performs more robustly than existing approaches. In addition, the proposed algorithm outperforms state-of-art methods in global optimality under the varying level of outliers.