旋转矩阵计算角度差 根据旋转矩阵的估计值和真值计算角度误差 论文 Benchmarking 6DOF Outdoor Visual Localization in Changing Conditions中公式 R g t R_{gt} Rgt真值 R e s t R_{est} Rest估计值 二维矩阵形式 2 cos ( ∣ α ∣ ) = trace ( R g t − 1 R e s t )