1. 运动学基础：坐标系定义、刚体运动描述、齐次变换矩阵
各位同学，咱们今天聊聊运动学的基础。说实话，这部分内容看着有点数学味，但它是整个数控系统的地基。我在现场调机床的时候，遇到过太多因为坐标系没搞明白，导致撞刀、过切的事故。嗯，咱们从最根本的东西说起。
1.1 坐标系定义——你得先知道自己在哪
数控系统里，坐标系就是我们的“地图”。没有地图，你让刀往哪儿走？
我个人习惯把坐标系分成三类：
- 世界坐标系：也叫绝对坐标系，固定在机床床身上。它是整个系统的“绝对参考”。
- 工件坐标系：固定在工件上。你想想看，工件装夹位置变了，坐标系就得跟着变。
- 工具坐标系：固定在刀具末端。刀尖在哪，这个坐标系的原点就在哪。
我在项目中遇到过一件事：操作员把工件坐标系设错了，结果刀具直接往夹具上撞。还好速度慢，不然就是大修。所以，坐标系定义一定要反复确认。
重要原则：坐标系必须满足右手定则。X、Y、Z三个轴的方向，大拇指是X，食指是Y，中指是Z。这个别搞反了，搞反了就是镜像加工，出来的零件全是反的。
1.2 刚体运动描述——位置和姿态是两码事
刚体，说白了就是一个不会变形的物体。刀具、工件、工作台，都可以看作刚体。
描述一个刚体的运动，需要两个东西：
- 位置：用三个坐标 (x, y, z) 表示。这个简单，就是原点在哪。
- 姿态：用三个角度 (α, β, γ) 表示。这个稍微复杂点，它描述的是刚体“朝哪个方向”。
为什么会这样？因为一个刚体在空间里有6个自由度。3个平移，3个旋转。少一个，运动就不完整。
我记得有一次调试五轴机床，客户说刀轴方向不对。我一看，姿态角算错了。旋转顺序搞反了，导致刀轴偏了0.5度。加工出来的叶片曲面，轮廓度超差。嗯，这里要注意：旋转顺序很重要，不同的顺序得到的结果完全不同。
我的经验：描述姿态时，我建议用ZYX欧拉角顺序。先绕Z轴转，再绕Y轴转，最后绕X轴转。这个顺序在数控系统里最常用，也最直观。
1.3 齐次变换矩阵——把位置和姿态打包
好了，现在我们有位置和姿态了。但怎么把它们放在一起计算？
答案就是齐次变换矩阵。它是一个4x4的矩阵，把旋转和位移打包在一起。
结构是这样的：
| R11 R12 R13 Tx |
| R21 R22 R23 Ty |
| R31 R32 R33 Tz |
| 0 0 0 1 |左上角3x3是旋转矩阵R，描述姿态。右上角3x1是平移向量T，描述位置。最后一行是固定的 [0 0 0 1]。
你想想看，有了这个矩阵，一个刚体的完整状态就全了。而且，多个变换可以连乘。比如：
从世界坐标系到刀具坐标系的变换 = 世界到工件 × 工件到工具
这就是运动学正解的核心思想。
避坑指南：我曾经在项目里犯过一个低级错误——矩阵乘法顺序搞反了。记住，矩阵乘法不满足交换律。A×B 和 B×A 完全是两回事。在数控系统里，通常是从右往左乘，先发生的变换在右边。
1.4 知识体系总览
下面这张图，是我自己总结的运动学基础框架。你看一眼，心里就有数了。
1.5 实际应用中的小技巧
讲完了理论，咱们说说实际怎么用。
在数控系统里，齐次变换矩阵最常见的用法就是做坐标转换。比如：
- 把刀尖点的坐标从工具坐标系转换到世界坐标系
- 把加工路径从工件坐标系转换到机床坐标系
- 五轴联动时，计算旋转轴的角度
我建议你写代码的时候，先把变换矩阵封装成一个类。这样用起来方便，也不容易出错。
举个例子，一个简单的变换矩阵乘法：
// 伪代码示意
Matrix4x4 T_world_to_tool = T_world_to_workpiece * T_workpiece_to_tool;
Vector3 tool_pos_in_world = T_world_to_tool * tool_pos_in_tool;你看，就这么几行，坐标就转过去了。但要注意，矩阵的维度要对，4x4乘4x1，结果才是4x1。
我的习惯：每次写完变换矩阵，我都会手动验证一下。比如把原点 [0 0 0 1] 乘进去，看看结果对不对。这个小习惯，帮我避免了好几次低级错误。
好了，运动学基础就讲这么多。坐标系、刚体运动、齐次变换矩阵，这三样东西是后面所有内容的基础。你把它吃透了，后面的运动学正解、逆解、速度雅可比，学起来就顺了。
公众号:蓝海资料掘金营，微信deep3321