Abstract: Based on the orthogonality of rotation matrix, a constrained optimization approach is proposed to es-timate the rotation matrix. This method has three advantangcs: 1) it improves the estimation accuracy; 2)the estimated rotation matrix is orthgonal; 3) the estimation is independent of the achievement of input ro-tation matrix.