机器人学中的坐标系与姿态变换基础

1. 机器人学中的坐标系基础

在机器人学领域，坐标系是描述物体位置和姿态的基础工具。就像我们在日常生活中使用"前后左右"来描述方向一样，机器人也需要明确的参考系来理解自身和环境的关系。

1.1 世界坐标系与物体坐标系

世界坐标系（World Frame）是固定不变的全局参考系，相当于我们常说的"绝对坐标"。在机器人应用中，世界坐标系通常有以下两种主流定义方式：

• ENU（东-北-天）坐标系：

  • X轴指向正东方向
  • Y轴指向正北方向
  • Z轴垂直向上（与重力方向相反）
  • 广泛应用于地面机器人、自动驾驶等领域

• NED（北-东-地）坐标系：

  • X轴指向正北方向
  • Y轴指向正东方向
  • Z轴垂直向下（与重力方向相同）
  • 主要用于航空航天领域，如无人机、飞行器等

物体坐标系（Body Frame）则是固定在机器人本体上的坐标系，会随着机器人的移动而移动。在定义物体坐标系时，通常遵循以下原则：

1. 原点选择在机器人的质心位置
2. X轴指向机器人前进方向（机头方向）
3. Z轴根据坐标系类型确定（ENU向上，NED向下）
4. Y轴通过右手定则确定（Y = Z × X）

注意：在实际应用中，坐标系定义的一致性至关重要。不同团队或系统间必须明确约定使用哪种坐标系标准，否则会导致严重的定位和导航错误。

1.2 向量的两种身份

在坐标系变换中，向量扮演着两种不同的角色：

1. 位置向量：描述物体坐标系原点在世界坐标系中的位置
2. 基向量：描述物体坐标系各轴在世界坐标系中的方向

理解这两种向量的区别对于后续的坐标变换至关重要。位置向量告诉我们"机器人在哪里"，而基向量告诉我们"机器人朝哪个方向"。

2. 旋转矩阵：姿态描述的数学核心

2.1 旋转矩阵的几何意义

旋转矩阵是一个3×3的正交矩阵，用于描述一个坐标系相对于另一个坐标系的旋转关系。从几何角度看，旋转矩阵的每一列实际上就是物体坐标系基向量在世界坐标系中的投影。

例如，旋转矩阵WRB可以表示为：

code复制WRB = [ X轴在世界系中的投影 | Y轴在世界系中的投影 | Z轴在世界系中的投影 ]

这种表示方法非常直观，让我们能够直接从矩阵中读出物体坐标系各轴的方向。

2.2 旋转矩阵的性质

旋转矩阵具有两个重要性质：

1. 正交性：旋转矩阵的逆等于其转置（R⁻¹ = Rᵀ）

   • 这一性质使得旋转矩阵的求逆计算非常高效
   • 物理意义：反向旋转就是正向旋转的转置

2. 行列式为+1：det(R) = +1

   • 如果行列式为-1，则表示发生了镜像变换（这在刚体运动中不可能）
   • 这一性质可用于验证旋转矩阵的有效性

2.3 基础旋转矩阵

绕单个坐标轴旋转的矩阵是最基础的旋转矩阵：

1. **绕X轴旋转（Rol