刚体变换矩阵

对于一个变换矩阵 或者 , 它的形式表示两个含义:

  • 从 到 的变换
  • 在 的位姿表示