On Similarity Transformation Problems: Globally Optimal Results and Applications
Jin Wu,Chaoqun Wang,Chong Li,Yi Jiang,Chengxi Zhang,Yulong Huang,Yuhua Qi,Bohuan Xue,Jianhao Jiao,Rui Fan,Wei Zhang
DOI: https://doi.org/10.1109/TIM.2024.3438850
IF: 5.6
2024-01-01
IEEE Transactions on Instrumentation and Measurement
Abstract:Similarity transformation problems are important in robotic instrumentation and computer vision based measurements since in many cases the information of visually observed scene scale is unknown and must be restored for accurate 3-dimensional reconstruction. In existing solvers, the scale is often considered as a scalar, i.e., isotropic, which may be invalid for anisotropic-scale setups. This paper exploits some mathematical coincidences that will lead to efficient solution to these problems. Possible further applications also include hand-eye calibration and structure-from-motion. We revisit pose estimation problems within the framework of similarity transformation, the one that considers scale-stretching, rotation and translation simultaneously. Two major problems are taken into account, i.e., the scale-stretching point-cloud registration and perspective-n-points (PnP). It has been found out that these two problems are quite similar. Moreover, we solve the anisotropic-scale registration problem that is important and is a remaining unsolved one in previous literatures. To compute the globally optimal solution of these non-convex problems, algebraic solution is obtained to compute all local minima using computationally efficient methods. The designed algorithm is deployed for robotic-arm pose estimation. We also extend the algorithm for solving the problem of robust magnetometer calibration. Visual pose experiments verify the superiority of the proposed method compared with representatives, including P3P, Lambda-Twist P3P and EPnP, which can be reproduced by repository in https://github.com/zarathustr/APnP.