坐标系基础：世界坐标系、机器人坐标系、齐次变换矩阵
说实话，坐标系这个东西，刚入行时我觉得很简单——不就是几个箭头嘛。直到我第一次在产线上调试机器人，发现它死活抓不到工件，折腾了两天才意识到：哦，原来是坐标系搞反了。嗯，从那以后，我再也不敢小看这几个箭头了。
今天咱们就把坐标系这件事彻底聊透。你想想看，机器人要运动，总得有个参考系吧？就像你问别人「往前走三步」，这个「前」是相对于谁说的？这就是坐标系存在的意义。
2.1 世界坐标系：机器人的「参考系」
世界坐标系，说白了就是整个机器人工作空间的「大地基准」。它固定在地面上，不随任何东西移动。我个人习惯把世界坐标系的原点设在机器人底座的中心，Z轴指向上方，X轴指向机器人前方。
我在项目中遇到过这样一个坑：有次调试AGV（自动导引车），团队里有人把世界坐标系原点设在了墙角，结果每次重启机器人，定位误差都在5厘米以上。后来发现，墙角那个位置温度变化大，金属膨胀导致原点漂移。所以我的建议是：世界坐标系原点尽量选在温度稳定、结构坚固的位置。
世界坐标系的主要用途：
- 定义机器人的工作空间边界
- 作为所有轨迹规划的全局参考
- 多机器人协同时的统一基准
- 传感器数据融合的锚点
2.2 机器人坐标系：每个关节都有自己的「小世界」
机器人坐标系，也叫基坐标系或工具坐标系。每个关节、每个连杆都有自己的坐标系。为什么会这样？因为机器人运动学计算需要知道每个部件之间的相对位置关系。
举个例子：你的手臂上臂有一个坐标系，前臂有一个坐标系，手掌还有一个坐标系。当你抬手时，手掌坐标系相对于上臂坐标系的位置就变了。机器人也是一样，每个关节的坐标系都在实时变化。
| 坐标系名称 | 原点位置 | 典型用途 |
|---|---|---|
| 基坐标系 | 机器人底座中心 | 关节角度计算、逆运动学 |
| 工具坐标系 | 末端执行器 | 抓取、焊接、喷涂 |
| 用户坐标系 | 工件或工作台 | 简化编程、路径规划 |
2.3 齐次变换矩阵：坐标系的「翻译官」
好了，现在我们有世界坐标系、机器人坐标系、工具坐标系……这么多坐标系，怎么让它们互相沟通？答案就是齐次变换矩阵。
齐次变换矩阵是一个4x4的矩阵，它能把一个点从一个坐标系「翻译」到另一个坐标系。说白了，就是坐标系的「语言翻译官」。
// 齐次变换矩阵的标准形式
// [R t]
// [0 1]
// 其中 R 是 3x3 旋转矩阵
// t 是 3x1 平移向量
// 示例：将点从工具坐标系转换到基坐标系
// base_point = T_tool_to_base * tool_point
// 假设工具坐标系相对于基坐标系平移 (0.1, 0.0, 0.2) 米，无旋转
T = [
[1, 0, 0, 0.1],
[0, 1, 0, 0.0],
[0, 0, 1, 0.2],
[0, 0, 0, 1.0]
]
// 工具坐标系中的点 (0, 0, 0.1)
tool_point = [0, 0, 0.1, 1]
// 转换到基坐标系
base_point = T * tool_point
// 结果: [0.1, 0.0, 0.3, 1]
2.4 坐标系变换的链式法则
实际应用中，我们很少直接从一个坐标系跳到另一个。通常是链式变换：世界→基座→关节1→关节2→……→工具。每个环节用一个齐次变换矩阵表示，最终变换就是这些矩阵的乘积。
你想想看，这就像你从北京到上海，中间经过济南、南京。每个城市之间的路线就是一个变换矩阵，最终路线就是这些矩阵的「串联」。
// 链式变换示例
// T_world_to_tool = T_world_to_base * T_base_to_j1 * T_j1_to_j2 * ... * T_jn_to_tool
// 实际代码中，我们通常这样写
Eigen::Matrix4d T_world_to_tool = T_world_to_base;
for (int i = 0; i < num_joints; ++i) {
T_world_to_tool = T_world_to_tool * T_joint[i];
}
T_world_to_tool = T_world_to_tool * T_tool_offset;
2.5 知识体系总览
为了让你更直观地理解这些概念之间的关系，我画了一张图。这张图展示了从世界坐标系到工具坐标系的完整变换链路，以及每个环节的核心作用。
这张图里，从世界坐标系到工具坐标系，每一步都对应一个齐次变换矩阵。实际编程中，我们只需要维护好这些矩阵，机器人就能准确知道自己的「手」在空间中的位置。
2.6 实战经验总结
最后，分享几个我在项目中积累的经验：
- 坐标系命名要规范：我习惯用
frame_world、frame_base、frame_tool这样的命名，一看就知道是哪个坐标系。别用f1、f2这种，三个月后你自己都看不懂。 - 变换矩阵要验证：每次写完变换代码，先用已知点验证一下。比如让机器人回到零点，检查工具坐标系原点是否在预期位置。
- 记录坐标系定义：在代码注释里写清楚每个坐标系的原点、轴向定义。我见过太多项目因为坐标系定义不清晰，导致后期调试崩溃。
- 善用可视化工具：在仿真环境里把坐标系画出来，用不同颜色区分。看到坐标系在动，比看数字直观多了。
一句话总结：坐标系是机器人的「世界观」，齐次变换矩阵是坐标系之间的「翻译器」。搞懂了这两样，轨迹跟踪就成功了一半。
嗯，坐标系基础就聊到这里。记住，坐标系不是理论游戏，它直接决定了你的机器人能不能精准地走到目标位置。下次调试时，如果轨迹偏了，先检查坐标系——八成是这里出了问题。