2、坐标系与位姿表示：世界坐标系、机器人基坐标系、工具坐标系、齐次变换矩阵

各位同学，咱们今天聊点实在的。坐标系这玩意儿，说白了就是给机器人一个“方向感”。你想想看，如果连自己在哪、工具在哪、目标在哪都说不清楚，那机器人还怎么干活？

我个人习惯把坐标系理解成“定位的锚点”。在机器人世界里，我们通常要跟四个坐标系打交道：世界坐标系、机器人基坐标系、工具坐标系，还有那个看起来有点抽象的齐次变换矩阵。别急，我一个一个给你拆开讲。

2.1 世界坐标系：整个场景的“大地图”

世界坐标系，你可以把它想象成整个工厂车间的GPS。它固定在地面上，是所有坐标系的“老大哥”。

我在项目中遇到过这样一个场景：一条产线上有三台机器人协同工作。如果每台机器人只认自己的基坐标系，那它们之间怎么配合？这时候就需要一个统一的世界坐标系，把所有机器人的位置都映射到同一个地图上。

• 原点：通常选在车间地面的某个固定点，比如墙角或产线起点。
• 方向：一般Z轴朝上（对抗重力），X和Y轴根据产线布局来定。
• 作用：给所有设备一个统一的参考基准。

2.2 机器人基坐标系：机器人的“根”

基坐标系固定在机器人底座上。说白了，它就是机器人自己的“原点”。

嗯，这里要注意：基坐标系的原点通常位于机器人第一轴的中心，Z轴沿着第一轴的旋转轴线向上。你想想看，机器人所有关节的运动，最终都是相对于这个基坐标系来计算的。

我记得有一次调试，同事把基坐标系的原点设错了位置，结果机器人每次回零都撞到旁边的料架。后来我帮他重新标定了一下，问题就解决了。所以，基坐标系的标定一定要准确，这是机器人运动学的基础。

• 原点：机器人底座安装面的中心。
• Z轴：沿第一关节轴线向上。
• X轴：指向机器人正前方（通常与电缆出口方向一致）。

2.3 工具坐标系：机器人的“手”

工具坐标系，顾名思义，就是定义在机器人末端执行器上的坐标系。焊枪、夹爪、吸盘……你装了什么工具，工具坐标系就跟着它走。

为什么需要工具坐标系？因为机器人末端法兰盘的位置，不等于工具尖端的位置。你想想看，焊枪的尖端和法兰盘之间差了那么一大截，如果不做补偿，机器人以为自己在A点，实际焊枪尖在B点，那焊出来的东西肯定歪了。

我曾经在焊接项目里吃过这个亏。当时用的焊枪长度没标定准确，结果焊出来的焊缝偏了2毫米。后来我重新用“四点法”标定了工具坐标系，精度一下子就上来了。

• 原点：工具的有效工作点（TCP，Tool Center Point）。
• 方向：根据工具的使用姿态来定义，比如焊枪的Z轴通常沿枪管方向。
• 标定方法：常用“四点法”或“六点法”。

2.4 齐次变换矩阵：坐标系的“翻译官”

好了，现在我们有三个坐标系了。但问题来了：怎么把一个坐标系下的点，转换到另一个坐标系下？

答案就是齐次变换矩阵。说白了，它就是一个4x4的矩阵，里面同时包含了旋转和平移的信息。

齐次变换矩阵 T 的形式：
T = [ R   p ]
    [ 0   1 ]

其中：
R：3x3 旋转矩阵（描述姿态）
p：3x1 平移向量（描述位置）
0：1x3 零向量
1：标量 1

为什么叫“齐次”？因为它在三维坐标后面加了一个维度（通常为1），这样旋转和平移就可以用一个矩阵乘法搞定了。你想想看，如果没有齐次坐标，旋转用3x3矩阵，平移用向量加法，那得多麻烦？

我个人习惯把齐次变换矩阵理解成“坐标系的翻译官”。比如，工具坐标系下的一个点，乘以工具到基座的变换矩阵，就变成了基坐标系下的点。再乘以基座到世界的变换矩阵，就变成了世界坐标系下的点。

2.5 知识体系结构图

下面这张图，帮你理清这四个概念之间的关系：

2.6 实际应用中的坐标系链

在实际项目中，坐标系不是孤立存在的。它们组成了一条链：

1. 世界坐标系 → 定义整个工作空间。
2. 机器人基坐标系 → 相对于世界坐标系固定。
3. 工具坐标系 → 相对于基坐标系运动。
4. 工件坐标系（有时需要） → 定义在工件上，方便编程。

举个例子：你要让机器人去抓一个放在桌上的零件。流程是这样的：

• 先用视觉系统找到零件在世界坐标系下的位置。
• 然后通过世界到基座的变换，算出零件在基坐标系下的位置。
• 再通过基座到工具的变换，算出机器人各关节需要转多少角度。

你看，每一步都离不开坐标系和变换矩阵。

2.7 本章小结

好了，这一章的内容就这些。总结一下：

• 世界坐标系：全局参考，固定不动。
• 基坐标系：机器人自己的原点，运动学计算的基础。
• 工具坐标系：定义在工具上，让机器人知道“手”在哪。
• 齐次变换矩阵：坐标系之间的翻译官，用4x4矩阵搞定旋转和平移。

记住一句话：坐标系搞不清楚，机器人就动不明白。这是所有机器人编程的基石，一定要吃透。