参考：

视觉SLAM基础：算法精度评价指标（ATE、RPE）

写的很详细，暂时先不整理了。

有一个地方，要输出ape的旋转部分的时候，添加指令-r rot_part。