3. 机械臂运动学基础：正运动学（DH参数法）、逆运动学求解、雅可比矩阵与奇异性
各位同学，今天我们来啃机械臂运动学这块硬骨头。说实话，这章内容我讲了不下二十遍，但每次备课还是会发现新的感悟。运动学是机械臂控制的基石，你想想看，如果连手臂末端在哪儿都不知道，还谈什么抓取、装配？
3.1 正运动学：DH参数法
正运动学，说白了就是已知关节角度，求末端位姿。我刚开始做机器人时，总觉得这玩意儿就是矩阵乘法，没啥技术含量。直到有一次在产线上调试六轴机器人，发现末端位置总是偏了2毫米，查了半天才发现是DH参数表里一个符号写反了。
DH参数法有四个核心参数，我习惯用这个口诀记：扭距偏角。嗯，就是扭转角、距离、偏移、关节角。
| 参数 | 符号 | 物理含义 |
|---|---|---|
| 连杆长度 | ai-1 | 沿xi-1轴，从zi-1到zi的距离 |
| 连杆扭转角 | αi-1 | 绕xi-1轴，从zi-1到zi的转角 |
| 连杆偏距 | di | 沿zi轴，从xi-1到xi的距离 |
| 关节角 | θi | 绕zi轴，从xi-1到xi的转角 |
标准DH的变换矩阵长这样：
T = [cosθ -sinθ·cosα sinθ·sinα a·cosθ
sinθ cosθ·cosα -cosθ·sinα a·sinθ
0 sinα cosα d
0 0 0 1]我个人习惯用改进DH（Modified DH），因为它在处理树形结构时更直观。不过标准DH在工业机器人里更常见，看你的应用场景。
关键点：建立坐标系时，一定要保证z轴沿着关节旋转轴方向。我见过太多新手把z轴方向搞反，结果算出来的末端位姿天差地别。
3.2 逆运动学求解
逆运动学就更有意思了。已知末端位姿，求关节角度。这玩意儿没有唯一解，甚至可能无解。我在做移动平台+机械臂联合建图时，经常需要实时求解逆运动学，计算效率就是生命线。
求解方法主要有两种：
- 解析法：速度快，精度高，但只适用于特定构型。比如PUMA 560这种有球腕的机器人，可以解出8组解。
- 数值法：通用性强，但迭代慢，可能陷入局部最优。我一般用牛顿-拉夫森法，配合阻尼因子防止发散。
举个例子，对于一个2自由度平面机械臂：
// 已知末端位置 (x, y)，求关节角 θ1, θ2
// 连杆长度 L1, L2
// 先求 θ2（余弦定理）
cosθ2 = (x² + y² - L1² - L2²) / (2 * L1 * L2)
θ2 = ±acos(cosθ2) // 注意：正负对应肘部向上/向下
// 再求 θ1
θ1 = atan2(y, x) - atan2(L2*sinθ2, L1 + L2*cosθ2)避坑指南：我曾经在调试移动抓取机器人时，逆运动学求解一直报错。查了半天，发现是末端位姿矩阵的旋转部分不满足正交性——说白了就是矩阵不是合法的旋转矩阵。记住：旋转矩阵的每一列必须是单位向量，且两两正交。
3.3 雅可比矩阵与奇异性
雅可比矩阵，这名字听着高大上，其实就是关节速度到末端速度的映射关系。我习惯把它理解为「速度的桥梁」。
对于n自由度机械臂，雅可比矩阵J是6×n的矩阵：
J = [Jv] // 线速度部分
[Jω] // 角速度部分
// 末端速度 = J * 关节速度
[v] [J11 J12 ... J1n] [θ1']
[ω] = [J21 J22 ... J2n] [θ2']
[...]
[θn']奇异性，就是雅可比矩阵秩不足的时候。说白了，机械臂在这个位姿下会失去某个方向的运动能力。我记得有一次在工厂里，机器人突然在某个点剧烈抖动，我一看就知道——碰到奇异点了。
常见的奇异构型：
- 边界奇异：手臂完全伸直或折叠
- 腕部奇异：腕关节的z轴与肩关节z轴共线
- 肘部奇异：肘关节角度为0或π
我的经验：处理奇异性，我一般用阻尼最小二乘法（DLS）。给雅可比矩阵的奇异值加个阻尼项，虽然会引入一点点误差，但至少不会让关节速度爆炸。代码实现大概是这样：
// 阻尼最小二乘法
J_damped = J' * inv(J * J' + λ² * I)
// λ是阻尼因子，一般取0.01~0.13.4 知识体系总览
下面这张图是我自己画的，把运动学的核心逻辑串起来了。你仔细看，正运动学和逆运动学是互逆关系，雅可比矩阵则是连接速度层的桥梁。
嗯，这章内容就到这里。运动学这东西，光看理论是不够的。我建议你找台真实的机械臂，或者用仿真软件，把DH参数表建起来，然后算一算正逆解。只有亲手调过几次奇异点，你才能真正理解雅可比矩阵的意义。
总结一下：正运动学是基础，逆运动学是核心，雅可比矩阵是进阶。三者的关系就像盖房子——地基、框架、装修，缺一不可。
可可精品资料库