Numerical optimization on the Euclidean group with applications to camera calibration

We present the cyclic coordinate descent (CCD) algorithm for optimizing quadratic objective functions on SE(3), and apply it to a class of robot sensor calibration problems. Exploiting the fact that SE(3) is the semidirect product of SO(3) and /spl Rfr//sup 3/, we show that by cyclically optimizing between these two spaces, global convergence can be assured under a mild set of assumptions. The CCD algorithm is also invariant with respect to choice of fixed reference frame (i.e., left invariant, as required by the principle of objectivity). Examples from camera calibration confirm the simplicity, efficiency, and robustness of the CCD algorithm on SE(3), and its wide applicability to problems of practical interest in robotics.

[1]  U. Helmke,et al.  Optimization and Dynamical Systems , 1994, Proceedings of the IEEE.

[2]  Hanqi Zhuang,et al.  A Note on "Hand-Eye Calibration" , 1997, Int. J. Robotics Res..

[3]  David S. Bayard.  An optimization result with application to optimal spacecraft reaction wheel orientation design , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[4]  Frank Chongwoo Park,et al.  Robot sensor calibration: solving AX=XB on the Euclidean group , 1994, IEEE Trans. Robotics Autom..

[5]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[6]  Joel W. Burdick,et al.  Objective and Frame-Invariant Kinematic Metric Functions for Rigid Bodies , 2000, Int. J. Robotics Res..

[7]  Frank Chongwoo Park,et al.  The optimal kinematic design of mechanisms , 1991 .

[8]  S. Shankar Sastry,et al.  A differential geometric approach to computer vision and its applications in control , 2000 .

[9]  F. Park.  Distance Metrics on the Rigid-Body Motions with Applications to Mechanism Design , 1995 .

[10]  R. Brockett,et al.  Dynamical systems that sort lists, diagonalize matrices and solve linear programming problems , 1988, Proceedings of the 27th IEEE Conference on Decision and Control.

[11]  Zexiang Li,et al.  Geometric algorithms for workpiece localization , 1998, IEEE Trans. Robotics Autom..

[12]  D. Taghirad.  Ieee Transactions on Robotics and Automation 1 Robust Torque Control of Harmonic Drive Systems , 1997 .

[13]  E. M. L. Beale,et al.  Nonlinear Programming: A Unified Approach. , 1970 .

[14]  김중곤.  Numerical optimization on the rotation group , 1998 .

[15]  R. Brockett.  Least squares matching problems , 1989 .

[16]  Vijay R. Kumar,et al.  New metrics for rigid body motion interpolation , 2000 .

[17]  R. Brockett.  Dynamical systems that sort lists, diagonalize matrices, and solve linear programming problems , 1991 .

[18]  Yiu Cheung Shiu,et al.  Calibration of wrist-mounted robotic sensors by solving homogeneous transform equations of the form AX=XB , 1989, IEEE Trans. Robotics Autom..

[19]  A. Bloch,et al.  Nonholonomic Control Systems on Riemannian Manifolds , 1995 .

[20]  Roger Y. Tsai,et al.  A versatile camera calibration technique for high-accuracy 3D machine vision metrology using off-the-shelf TV cameras and lenses , 1987, IEEE J. Robotics Autom..

[21]  F. Park,et al.  Geometric Descent Algorithms for Attitude Determination Using the Global Positioning System , 2000 .