第二章：坐标系与运动学基础
各位同学，今天我们来聊聊数控系统里最基础、也最绕不开的一块——坐标系与运动学。说实话，我刚入行那会儿，觉得坐标系不就是个xyz嘛，有啥好学的？结果第一次调五轴机床，工件坐标系设错了，刀具直接撞了上去……嗯，从那以后，我再也不敢小看坐标系了。
2.1 机床坐标系与工件坐标系
先说说这两个坐标系的关系。你想想看，机床本身有一个固定的坐标系，叫机床坐标系（Machine Coordinate System, MCS）。它通常以机床的零点为原点，X、Y、Z轴方向由机床结构决定。这个坐标系是“出厂设定”，一般不能改。
但实际加工时，我们关心的是工件的位置。所以就有了工件坐标系（Workpiece Coordinate System, WCS）。它是以工件上的某个点（比如毛坯的角点或中心）为原点建立的坐标系。说白了，就是“机床坐标系”是机床的“家”，而“工件坐标系”是工件的“家”。
关键点：数控系统通过一个变换矩阵，把工件坐标系下的坐标，映射到机床坐标系下。这个矩阵就是后面要讲的齐次变换矩阵。
我在项目中遇到过一件事：一个操作员在设置工件坐标系时，把Z轴偏置设反了。结果刀具直接往工件里扎，把工件和刀都毁了。所以，我建议每次设置完坐标系后，先手动走一遍安全高度，确认无误再开自动。
2.2 刚体运动学基础
数控机床的运动，本质上就是刚体运动。刚体，就是不会变形的物体。机床的每个轴（比如X轴、Y轴、Z轴）都可以看作一个刚体，它们之间通过导轨、丝杠等连接。
刚体运动学主要研究两个问题：
- 位置：刚体在空间中的坐标（x, y, z）。
- 姿态：刚体在空间中的朝向（通常用欧拉角或四元数表示）。
举个例子：一个五轴机床的刀轴，不仅要移动到某个点，还要倾斜到某个角度。这个“倾斜”就是姿态控制。我记得有一次调试五轴联动，刀轴姿态算错了，结果加工出来的曲面全是刀痕。后来发现是欧拉角的顺序搞反了——嗯，这里要注意，欧拉角的顺序（比如ZYX还是XYZ）直接影响结果。
2.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]，用来保持齐次性。
为什么要用4x4矩阵？因为这样可以把旋转和平移统一成一个矩阵乘法。你想想看，如果分开算，先旋转再平移，公式会变得很复杂。而用齐次变换矩阵，一次乘法就搞定。
我的习惯：在写代码时，我通常用numpy的矩阵运算来处理齐次变换。比如：
import numpy as np
# 定义旋转矩阵（绕Z轴旋转30度）
theta = np.radians(30)
R = np.array([[np.cos(theta), -np.sin(theta), 0],
[np.sin(theta), np.cos(theta), 0],
[0, 0, 1]])
# 定义平移向量
T = np.array([100, 200, 50])
# 构建齐次变换矩阵
H = np.eye(4)
H[:3, :3] = R
H[:3, 3] = T
print(H)
2.4 正逆运动学求解
正运动学，就是已知各个关节的角度（或位移），求刀具末端的位置和姿态。逆运动学，就是已知刀具末端的位置和姿态，反求各个关节的角度（或位移）。
对于三轴机床，正逆运动学都很简单：
- 正解：刀具位置 = (X轴位置, Y轴位置, Z轴位置)。
- 逆解：X轴位置 = 刀具X坐标，Y轴位置 = 刀具Y坐标，Z轴位置 = 刀具Z坐标。
但对于五轴机床，事情就复杂了。因为多了两个旋转轴（比如A轴和C轴），正逆解都涉及三角函数和矩阵运算。我曾经在调试一台AC双摆头五轴机床时，逆解算出来的角度总是差一点。后来发现是旋转轴的零点偏了0.1度——嗯，这种误差在五轴加工里是致命的。
避坑指南：我曾经因为逆解算法里少考虑了一个旋转轴的偏置，导致加工出来的零件全部报废。所以，我建议在写逆解代码时，一定要先做仿真验证，或者用已知点反算验证。
知识体系总览
下面这张图，是我自己画的本章知识结构。你可以看到，坐标系是基础，运动学是核心，齐次变换矩阵是工具，正逆解是应用。它们环环相扣，缺一不可。
好了，这一章的内容就到这里。坐标系和运动学是数控系统的“地基”，地基不牢，后面再花哨的算法都是空中楼阁。下一章我们会深入轨迹插补，到时候你会看到，今天学的这些矩阵和变换，会像积木一样被反复使用。