第4章 坐标变换基础：齐次变换矩阵、欧拉角与方向余弦
做五轴后处理，说白了就是跟坐标系打交道。你想想看，工件在机床上转来转去，刀轴方向变来变去，这背后全是坐标变换在撑着。我刚开始接触五轴时，觉得这东西玄乎得很，后来搞明白了，其实就是几个数学工具来回用。
4.1 齐次变换矩阵：把旋转和平移装进一个盒子里
先说说齐次变换矩阵。这东西就是个4x4的矩阵，能把旋转和平移打包在一起处理。为什么要这么干？因为在实际加工中，刀轴既要转方向，刀尖又要移动位置，分开算太麻烦。
一个标准的齐次变换矩阵长这样：
| R11 R12 R13 Tx |
| R21 R22 R23 Ty |
| R31 R32 R33 Tz |
| 0 0 0 1 |左上角3x3是旋转矩阵，右上角3x1是平移向量。最后一行固定是[0 0 0 1]，这是齐次坐标的规矩。
核心要点：齐次变换矩阵的乘法可以串联多个变换。比如从工件坐标系到机床坐标系，中间可能经过夹具坐标系、主轴坐标系，每个环节对应一个矩阵，乘起来就是最终结果。
我在项目中遇到过一件事：有个同事手动计算坐标变换，算到一半发现符号搞反了，结果撞了刀。后来我建议他用齐次矩阵统一处理，再也没出过这种低级错误。
4.2 欧拉角：描述旋转的三种方式
欧拉角这东西，说白了就是用三个角度来描述一个旋转。常见的顺序有ZYX、ZXZ、XYZ等。五轴后处理里最常用的是ZYX顺序，也就是先绕Z轴转，再绕Y轴转，最后绕X轴转。
为什么会有这么多顺序？因为旋转不满足交换律。你先绕X转30度再绕Y转45度，跟先绕Y转45度再绕X转30度，结果完全不同。所以定义欧拉角时，必须说清楚旋转顺序。
| 旋转顺序 | 应用场景 | 说明 |
|---|---|---|
| ZYX | 五轴摇篮式机床 | 最常用，对应AC轴或BC轴 |
| ZXZ | 摆头式机床 | 适合主轴摆动的结构 |
| XYZ | 机器人运动学 | 工业机器人常用 |
我个人习惯用ZYX顺序，因为跟五轴机床的物理轴对应得最直接。A轴绕X转，C轴绕Z转，B轴绕Y转，刚好对上。
避坑指南：我曾经在调试一台AC摇篮机床时，发现后处理出来的角度总是差那么一点点。查了半天，原来是欧拉角顺序搞错了。机床手册上写的是ZYX，我默认用了XYZ，结果差了十万八千里。记住：一定要先确认机床的旋转顺序！
4.3 方向余弦：用向量说话
方向余弦矩阵，其实就是旋转矩阵的另一种叫法。它用三个单位向量来描述一个坐标系相对于另一个坐标系的姿态。每个向量有三个分量，加起来就是3x3的矩阵。
举个例子，刀轴方向向量是[i, j, k]，这个向量在工件坐标系里表示。但机床不认识这个向量，它只认识旋转角度。所以我们需要把[i, j, k]转换成欧拉角，或者直接转换成旋转矩阵。
// 从刀轴向量计算旋转矩阵
// 假设刀轴方向为 (i, j, k)
// 先归一化
len = sqrt(i*i + j*j + k*k)
i = i/len; j = j/len; k = k/len
// 构建旋转矩阵（ZYX顺序）
R11 = cos(C)*cos(B)
R12 = cos(C)*sin(B)*sin(A) - sin(C)*cos(A)
R13 = cos(C)*sin(B)*cos(A) + sin(C)*sin(A)
// ... 其他元素类似你想想看，如果直接用欧拉角去算，很容易出现万向锁问题。但用方向余弦矩阵，就不会有这个问题。矩阵运算天生就是连续的，不会突然跳变。
4.4 从工件坐标系到机床坐标系的转换
好了，前面铺垫了这么多，终于到正题了。从工件坐标系到机床坐标系，中间要经过好几层变换：
- 工件坐标系 → 夹具坐标系：工件装夹在夹具上，有个偏移量
- 夹具坐标系 → 工作台坐标系：夹具固定在工作台上，又有偏移
- 工作台坐标系 → 机床坐标系：工作台可能旋转或摆动，这是五轴的核心
每一步对应一个齐次变换矩阵。把它们乘起来：
T_total = T_machine * T_table * T_fixture * T_workpiece注意乘法的顺序。矩阵乘法不满足交换律，顺序错了结果全错。我一般从右往左读：先处理工件，再处理夹具，再处理工作台，最后到机床。
警告：千万不要搞混乘法的左右顺序！我曾经见过一个工程师，把矩阵乘法的顺序写反了，结果后处理出来的程序在机床上跑，刀轴方向完全反了。幸好是空跑测试，不然就出大事了。
在实际调试中，我习惯先把每个变换矩阵单独写出来，然后一步一步乘。每乘一步就检查一下结果是否合理。比如平移量对不对，旋转方向对不对。这样即使出错了，也能很快定位到是哪一步的问题。
嗯，这里要注意一点：机床的旋转轴有正负方向定义。有的机床A轴正转是顺时针，有的是逆时针。这个必须在后处理里明确，不然角度符号搞反了，后果很严重。
我记得有一次调试一台BC轴机床，B轴的正方向定义跟标准不一样。我按照常规写了后处理，结果模拟时发现刀轴方向总是偏。后来查手册才发现，这台机床的B轴正方向是反的。从那以后，我每次调试新机床，第一件事就是确认各轴的正方向。
总结一下：坐标变换的核心就是三个工具——齐次变换矩阵、欧拉角、方向余弦。齐次矩阵负责统一处理旋转和平移，欧拉角负责描述旋转顺序，方向余弦负责避免万向锁。三者配合使用，就能搞定从工件坐标系到机床坐标系的转换。
好了，这一章的内容就这些。坐标变换是五轴后处理的基石，搞懂了它，后面的刀轴控制、RTCP补偿才能顺利理解。如果你在实际调试中遇到坐标变换的问题，不妨回到这三个工具上找找原因。