2. 坐标系与运动学基础：关节坐标系、笛卡尔坐标系、齐次变换矩阵
各位同学，咱们今天聊点实在的。坐标系这东西，听起来像是数学课本里的概念，但在运动控制里，它就是你的“地图”和“指南针”。没有它，机器人就是个瞎子。
我刚开始做项目那会儿，就吃过这个亏。当时调试一个六轴机械臂，死活走不对位置。折腾了两天，最后发现是坐标系搞混了——我以为末端在笛卡尔空间里走直线，结果控制器一直在关节空间里做插补。嗯，那感觉，就像你拿着导航开车，结果导航用的是火星坐标。
所以，坐标系和运动学基础，是轨迹规划的“地基”。地基不稳，上面盖什么楼都得塌。
2.1 关节坐标系：机器人的“原生语言”
关节坐标系，说白了就是每个电机自己的角度值。你想想看，机器人身上每个关节都有一个编码器，它只认识0度、30度、-45度这些数字。
关节坐标系的定义：
- 每个关节独立一个轴，通常用 θ₁, θ₂, ..., θₙ 表示
- 坐标值就是关节的绝对角度或相对角度
- 单位：度（°）或弧度（rad）
举个例子，一个六轴机器人，它的关节坐标就是一个六维向量：
q = [θ₁, θ₂, θ₃, θ₄, θ₅, θ₆]ᵀ我在项目中遇到过一个问题：用关节坐标系做直线运动。结果呢？末端走的根本不是直线，而是一条弧线。为什么会这样？因为每个关节独立运动，它们的合成效果在笛卡尔空间里就是曲线。
核心要点：关节坐标系适合做点到点运动（PTP），但不适合做直线或圆弧插补。
我的习惯：调试阶段先用关节坐标系手动示教，确认每个关节的运动范围没问题。等机械结构验证完了，再切换到笛卡尔坐标系做轨迹规划。
2.2 笛卡尔坐标系：我们熟悉的“世界”
笛卡尔坐标系，就是咱们初中数学学的X、Y、Z轴。在运动控制里，它描述的是机器人末端在三维空间中的位置和姿态。
位置表示：
P = [x, y, z]ᵀ姿态表示： 这个稍微复杂点。常用的有欧拉角、旋转矩阵、四元数。我个人最常用的是旋转矩阵，因为它没有万向锁问题。
一个完整的笛卡尔坐标位姿是6维的：
X = [x, y, z, α, β, γ]ᵀ其中 α, β, γ 是绕X、Y、Z轴的旋转角度。
你想想看，如果我们要让机器人末端画一个圆，在关节坐标系里你得算半天。但在笛卡尔坐标系里，就是一个简单的圆方程：
x = R * cos(t)
y = R * sin(t)
z = constant这就是笛卡尔坐标系的威力——直观、好理解。
注意：笛卡尔坐标系下的轨迹规划，必须经过逆运动学转换成关节角度才能执行。这个转换不是一一对应的，同一个笛卡尔位置可能对应多个关节构型。我曾经就遇到过“奇异点”问题，机器人突然卡住不动了。嗯，那是逆运动学无解的情况。
2.3 齐次变换矩阵：连接两个世界的“桥梁”
关节坐标系和笛卡尔坐标系之间怎么转换？靠的就是齐次变换矩阵。
齐次变换矩阵是一个4×4的矩阵，它把旋转和平移统一在一个框架里：
T = | R p |
| 0 1 |其中：
- R 是3×3的旋转矩阵
- p 是3×1的平移向量
- 最后一行是 [0, 0, 0, 1]
为什么叫“齐次”？说白了，就是为了把旋转和平移写成一次矩阵乘法。如果不加这一维，平移就得单独加，麻烦得很。
一个典型的齐次变换矩阵示例：
T = [[cosθ, -sinθ, 0, a],
[sinθ, cosθ, 0, b],
[0, 0, 1, c],
[0, 0, 0, 1]]这个矩阵表示：先绕Z轴旋转θ角，再平移 (a, b, c)。
关键理解：齐次变换矩阵可以“链式相乘”。比如从基座到末端，中间经过N个关节，那么总的变换矩阵就是：
T_0n = T_01 * T_12 * T_23 * ... * T_(n-1)n这就是正运动学的核心。
2.4 知识体系结构图
下面我用一张SVG图来展示本章的知识脉络，方便你整体把握：
2.5 实际应用中的避坑指南
讲完了理论，咱们聊聊实战中容易踩的坑。
我曾经踩过的坑：
- 坐标系混淆：有一次我把工具坐标系和用户坐标系搞反了，结果机器人末端撞到了工件上。从那以后，我每次切换坐标系都会在代码里加一个断言检查。
- 旋转顺序问题：欧拉角的旋转顺序（XYZ、ZYX等）不同，结果完全不同。我习惯用ZYX顺序，但一定要在文档里写清楚。
- 齐次矩阵的最后一列：平移向量是相对于哪个坐标系？是基座标系还是工具坐标系？这个必须明确。
我的调试小技巧：
- 先用简单的单轴运动验证正运动学是否正确
- 用示教器手动移动机器人，观察笛卡尔坐标的变化是否合理
- 在代码里打印齐次变换矩阵的数值，和理论值对比
2.6 小结
这一章咱们聊了三个核心概念：
- 关节坐标系——机器人的“母语”，每个电机都懂
- 笛卡尔坐标系——我们人类的“普通话”，直观好理解
- 齐次变换矩阵——连接两者的“翻译官”，数学上优雅统一
记住一句话：关节坐标系是执行层，笛卡尔坐标系是规划层，齐次变换矩阵是连接层。这三者缺一不可。
下一章咱们会深入聊正运动学和逆运动学的具体计算方法。到时候你会发现，齐次变换矩阵的链式乘法，就是正运动学的全部秘密。