Pinocchio源码阅读——刚体运动物理量空间变换及求导设位姿 g=[Rp01]∈SE(3),g=\begin{bmatrix}R&p\\0&1\end{bmatrix}\in SE(3),g=[R0p1]∈SE(3),其中 R∈SO(3)R\in SO(3)R∈SO(3),p∈R3p\in\mathbb R^3p∈R3。本文约定 ggg 表示从局部/物体坐标系 BBB 到空间/惯性坐标系 AAA 的变换: xA=RxB+p.x_A=R x_B+p.xA=RxB+p. 6D 旋量顺序按 [linear; angular] 排列。若使用 [angular; li