机器人学基础：刚体运动学与坐标系变换详解

1. 具身智能中的刚体运动学基础

刚体运动学是机器人学和具身智能领域的数学基石。在真实物理环境中，智能体需要精确描述自身和环境中物体的位置、姿态及其变化规律。刚体运动学主要研究物体在空间中的位置和姿态随时间变化的规律，而不考虑导致这些变化的力和质量因素。

我刚进入机器人领域时，曾经对"为什么需要这么多数学工具描述简单的位置变化"感到困惑。直到第一次编程让机械臂抓取物体时，才深刻理解精确数学描述的重要性——哪怕1毫米的误差都可能导致任务失败。刚体运动学正是为解决这类问题而生的数学工具包。

2. 坐标系变换：空间关系的语言

2.1 坐标系的基本概念

在三维空间中，我们通常用右手坐标系来描述物体的位置。X、Y、Z三轴满足右手定则：右手四指从X轴转向Y轴时，拇指指向Z轴正方向。这种约定在机器人学中几乎成为行业标准，比如常见的UR机械臂、Franka Emika等工业机器人均采用此标准。

实际应用中，我们会遇到多种坐标系：

• 世界坐标系（World Frame）：固定的全局参考系
• 物体坐标系（Body Frame）：固定在刚体上的局部参考系
• 相机坐标系（Camera Frame）：以相机光学中心为原点的坐标系
• 工具坐标系（Tool Frame）：安装在机械臂末端的工具参考系

2.2 坐标系变换的数学表达

两个坐标系之间的变换包含平移和旋转两部分。假设我们有两个坐标系A和B，点P在A系中的坐标为^AP，在B系中的坐标为^BP，则变换关系可表示为：

^AP = ^A_BR · ^BP + ^AP_

其中^A_BR是旋转矩阵，^AP_{Borg}表示B系原点在A系中的坐标。这个看似简单的公式在实际应用中却有许多需要注意的细节。

注意：在实现坐标系变换代码时，务必明确每个变量的参考坐标系。我在早期项目中曾因混淆坐标系导致机械臂运动轨迹完全错误，这个错误花费了两天时间才排查出来。

3. 旋转的数学表示方法

3.1 旋转矩阵：直观但冗余

旋转矩阵是描述刚体旋转最直接的方式。一个3×3的正交矩阵R满足R^T R = I（单位矩阵），且det(R)=1。旋转矩阵的每个列向量实际上表示新坐标系基向量在原坐标系中的投影。

例如，绕Z轴旋转θ角的旋转矩阵为：
R_z(θ) = [cosθ -sin