第2章运动学基础

运动学基础：坐标系与变换

各位工程师朋友，大家好。我是老张，在运动控制这行摸爬滚打了十几年。今天咱们来聊聊三轴联动里最基础、也最绕不开的一块——坐标系与变换。

说实话，我刚入行那会儿，觉得坐标系这东西太简单了，不就是XYZ嘛。结果第一次调试五轴机床，坐标系搞反了，刀具直接撞了上去……嗯，从那以后，我再也不敢小看坐标系了。

先说说两个最常用的坐标系。

世界坐标系，也叫基坐标系。你可以把它想象成整个工作空间的“绝对参考系”。机器人的底座、工作台的零点，都定义在这个坐标系里。我习惯把世界坐标系固定在地面上，这样所有运动部件的位置都能统一度量。

工具坐标系，这个就灵活多了。它附着在末端执行器上，比如焊枪的尖端、夹爪的中心。为什么要单独搞一个工具坐标系？因为实际干活的是工具，不是机器人本体。你想想看，机器人手腕转个角度，焊枪尖的位置就变了。如果只用世界坐标系去描述焊枪尖的运动，那计算量会非常恐怖。

核心区别：世界坐标系是“全局的、固定的”，工具坐标系是“局部的、随动的”。

我在做焊接路径规划时，经常需要把工具坐标系的原点设在焊丝伸出端。这样，不管机器人怎么摆姿势，我只需要控制工具坐标系相对于焊缝的位置和姿态就行。说白了，就是把复杂问题简化了。

坐标系之间怎么变换？靠矩阵。

平移矩阵很简单。假设你想把一个点从世界坐标系移到工具坐标系，如果两个坐标系只是平移关系，那直接加减坐标值就行。但实际中，旋转才是麻烦事。

旋转矩阵，这个我得好好说说。它描述了一个坐标系相对于另一个坐标系的姿态变化。比如绕X轴旋转30度，绕Y轴旋转45度，这些都可以用3x3的矩阵表示。

我记得有一次，一个同事问我：“为什么旋转矩阵的逆矩阵就是它的转置？”我告诉他，因为旋转矩阵是正交矩阵，这个性质在路径插补时特别有用。你想想看，如果你要从工具坐标系转换回世界坐标系，直接转置矩阵就行，省了多少计算量。

常用的旋转矩阵有这三种：

个人经验：实际项目中，我很少单独用旋转矩阵。因为连续多次旋转后，矩阵会变得很复杂，而且容易产生万向锁问题。这时候，我更喜欢用四元数。

好了，平移和旋转分开讲都很清楚。但实际中，它们往往是同时发生的。比如机器人从A点走到B点，既转了角度，又移动了位置。这时候，就需要齐次坐标出场了。

齐次坐标，说白了就是在三维坐标后面加一个维度，变成四维。比如点(x,y,z)变成(x,y,z,1)。为什么要这么做？因为这样就能用一个4x4的矩阵同时表示平移和旋转了。

这个4x4矩阵，就是齐次变换矩阵。它的结构是这样的：

| R   T |
| 0   1 |

其中R是3x3的旋转矩阵，T是3x1的平移向量。最后一行是[0,0,0,1]。

你想想看，有了这个矩阵，坐标系之间的变换就变成了一次矩阵乘法。不管是正向变换还是逆向变换，都统一了。我在做三轴联动插补时，每个轴的运动轨迹最终都要转换到世界坐标系下，用的就是齐次变换矩阵。

避坑指南：我曾经在项目里犯过一个低级错误——忘记把齐次坐标的最后一个分量归一化。结果算出来的位置偏差了好几毫米。记住，齐次坐标的最后一个分量必须是1，否则要除以它做归一化。

下面这张图，是我自己总结的运动学坐标系知识体系。你可以把它当作一个快速索引：

这张图把本章的核心逻辑串起来了。你从上往下看：先确定用世界坐标系还是工具坐标系，然后根据运动需求选择平移或旋转，最后用齐次变换矩阵把它们统一起来。

说了这么多理论，最后分享一个实际案例。去年我做了一个三轴点胶机的路径优化项目。点胶头需要沿着一个复杂曲面运动，既要保持垂直姿态，又要精确控制胶量。

我当时的做法是：把点胶头定义为工具坐标系，工件曲面定义在世界坐标系中。然后通过齐次变换矩阵，把工具坐标系下的运动指令实时转换到世界坐标系下。这样，我只需要在工具坐标系里规划路径，剩下的交给矩阵运算。

结果呢？路径精度从原来的±0.5mm提高到了±0.05mm。嗯，这就是坐标系变换的魅力。

一个小技巧：如果你在调试时发现运动轨迹不对，先别急着改参数。检查一下坐标系定义是否正确。我敢说，80%的运动控制问题，根源都在坐标系上。