Publication
On closed-form formulas for the 3-D nearest rotation matrix problem
Journal Article (2020)
Journal
IEEE Transactions on Robotics
Pages
1333-1339
Volume
36
Number
4
Doc link
http://dx.doi.org/10.1109/TRO.2020.2973072
File
Abstract
The problem of restoring the orthonormality of a noisy rotation matrix by finding its {em nearest} correct rotation matrix arises in many areas of robotics, computer graphics, and computer vision. When the Frobenius norm is taken as the measure of closeness, the solution is usually computed using the singular value decomposition (SVD). A closed-form formula exists but, as it involves the roots of a polynomial of third degree, it is assumed to be too complicated and numerically ill-conditioned. In this paper, we show how, by carefully using some algebraic recipes scattered in the literature, it is possible to derive a simple and yet numerically stable formula for most practical applications. Moreover, by relying on a result that permits obtaining the quaternion corresponding to the sought optimal rotation matrix, we present another closed-form formula that provides a good approximation to the optimal one using only the elementary algebraic operations of addition, subtraction, multiplication and division. These two closed-form formulas are compared with respect to the SVD in terms of accuracy and computational cost.
Categories
robot dynamics, robot kinematics, robot vision.
Scientific reference
S. Sarabandi, A. Shabani, J.M. Porta and F. Thomas. On closed-form formulas for the 3-D nearest rotation matrix problem. IEEE Transactions on Robotics, 36(4): 1333-1339, 2020.
Follow us!