The proposed algorithm preserves the orthogonality of rotation matrices and updates all variables iteratively. Furthermore, we deduce that only five degrees of freedom (DoFs) in radar pose are ...