手眼标定算法---Navy算法（Robot sensor calibration: solving AX=XB on the Euclidean group）