SO(3)上姿态误差函数Ψ的直观含义与度量属性问询

一、Ψ的直观含义 #

先帮你修正个小推导细节：根据你给出的定义$$ \Psi(R, R_d) = \frac{1}{2}\text{tr}(I - R_d^{\top}R) $$，结合旋转矩阵的迹性质——任意旋转矩阵$R(\phi)$的迹是$1+2\cos\phi$（$\phi$是轴角表示的旋转角），咱们可以推导出：
$$
\Psi(R, R_d) = 1 - \cos\phi
$$
这里的$\phi$是把姿态$R$转到$R_d$需要的相对旋转角，说白了就是两个姿态之间的“旋转差距”角度。

直观理解的话，这个函数就是用“1减去相对旋转角的余弦值”来给两个姿态的差异打分：

• 当$R$和$R_d$完全一样时，$\phi=0$，$\cos\phi=1$，$\Psi=0$，代表没有姿态误差；
• 当两个姿态相差整整$180^\circ$（$\phi=\pi$），$\cos\phi=-1$，$\Psi=2$，这是误差的最大值；
• 从$\phi=0$到$\phi=\pi$，$\Psi$从0单调涨到2，完美对应姿态差异从无到极致的变化。

简单说，$\Psi$的值越大，两个旋转姿态的差距就越大，它是个能直观反映姿态偏离程度的量化指标。

二、Ψ是否属于度量？ #

判断一个函数是不是度量，得满足四个硬条件：非负性、同一性、对称性、三角不等式。咱们一个个来核对：

1. 非负性：因为余弦值$\cos\phi$最大是1，所以$1-\cos\phi$肯定大于等于0，满足；
2. 同一性：$\Psi=0$当且仅当$\cos\phi=1$，也就是$\phi=0$，这时候$R$和$R_d$完全重合，满足；
3. 对称性：把$R$转到$R_d$的角度，和把$R_d$转到$R$的角度是一样的，所以$\Psi(R,R_d)$和$\Psi(R_d,R)$相等，满足；
4. 三角不等式：这是卡壳的地方。三角不等式要求对任意三个姿态$R_1,R_2,R_3$，必须有$\Psi(R_1,R_3) \leq \Psi(R_1,R_2) + \Psi(R_2,R_3)$，但咱们可以找个反例证明它不满足：

比如，让$R_1$到$R_2$绕同一轴转$60^{\circ$（$\phi_{12}=\pi/3$），$R_2$到$R_3$也绕这个轴转$60}\circ$（$\phi_{23}=\pi/3$），那$R_1$到$R_3$的总旋转角就是$120^\circ$（$\phi_{13}=2\pi/3$）。
计算数值：
$\Psi(R_1,R_2)=1-\cos(\pi/3)=0.5$，$\Psi(R_2,R_3)=0.5$，加起来是1；
但$\Psi(R_1,R_3)=1-\cos(2\pi/3)=1.5$，明显$1.5>1$，直接违反了三角不等式。

所以结论是：$\Psi$不属于度量。不过如果你需要满足度量性质的姿态距离，可以用它的变体$\sqrt{2\Psi}=2\sin(\phi/2)$，这是SO(3)上合法的度量（对应单位四元数的欧氏距离）。

内容的提问来源于stack exchange，提问作者Manish