第2章机器人运动学基础

2、机器人运动学基础：正运动学与逆运动学，DH参数法，坐标变换

各位同学，欢迎来到实战解析的第二讲。

今天咱们聊点硬核的——机器人运动学。说白了，就是搞清楚机器人的胳膊腿儿到底是怎么动的。你给它一个角度，它该在哪儿？你想让它去某个点，关节又该转多少？这就是正运动学和逆运动学要解决的问题。

我刚开始做机器人项目那会儿，总觉得这东西不就是几何题嘛，有啥难的？结果第一次调试六轴机器人，发现末端执行器死活对不准目标点。后来才明白，运动学这东西，差一个毫米，后面全白干。嗯，咱们今天就把这块地基打牢。

先问大家一个问题：机器人是怎么知道自己的手在哪儿的？

答案很简单——坐标系。每个关节都有自己的坐标系，机器人需要把这些坐标系串起来，才能算出末端的位置。

坐标变换的核心就三个东西：平移、旋转、缩放。工业机器人里，缩放基本用不上，所以主要就是平移和旋转。

我记得有一次，项目里用的机器人基座标系和视觉系统的坐标系没对齐。我花了整整一个下午，拿着激光测距仪在车间里量来量去，最后发现是旋转矩阵算反了。从那以后，我每次做坐标变换都会先画个草图，把旋转方向标清楚。

核心公式（齐次变换矩阵）：

T = [R   P]
    [0   1]

其中 R 是 3x3 旋转矩阵，P 是 3x1 平移向量。这个 4x4 矩阵，就是机器人运动学的灵魂。

说到机器人运动学，就绕不开 DH 参数法。Denavit 和 Hartenberg 这两位老前辈，在 1955 年提出了一套标准化的方法，用来描述相邻连杆之间的坐标变换。

我个人习惯把 DH 参数想象成「四步走」：

你想想看，只要这四个参数确定了，相邻两个关节之间的变换关系就唯一确定了。是不是很巧妙？

我的小技巧： 建立 DH 参数表时，先把每个关节的 Z 轴画出来，再确定 X 轴的方向。很多新手容易在 α 的正负号上栽跟头。我曾经就因为一个 α 符号搞反了，导致仿真里机器人直接「反关节」运动，差点把虚拟夹具撞坏。

正运动学，说白了就是「已知关节角度，求末端位姿」。这是最简单的方向，因为公式是确定的，没有歧义。

对于六轴机器人，正运动学就是一连串的矩阵乘法：

T_06 = T_01 * T_12 * T_23 * T_34 * T_45 * T_56

每个 T 矩阵都由 DH 参数决定。你只需要把六个关节角代入，就能得到末端执行器在基座标系下的位置和姿态。

我在项目中经常用正运动学来做两件事：一是验证逆运动学算得对不对，二是在示教模式下实时显示机器人末端位置。说白了，正运动学就是你的「照妖镜」，任何运动学问题，先用正运动学跑一遍，心里就有底了。

注意： 正运动学虽然简单，但矩阵乘法顺序不能搞错。左乘和右乘的结果完全不同。我建议你写代码时，把每个 T 矩阵单独算出来，再一步步乘，别偷懒写在一行里，调试起来会哭的。

逆运动学就麻烦多了。已知末端位姿，求六个关节角。这玩意儿没有唯一解，甚至可能无解。

为什么会这样？

因为机器人有多个关节，同一个末端位置，可能有多种「姿势」都能到达。比如你伸手去够桌上的杯子，你可以肘部朝下，也可以肘部朝外——这就是多解。

逆运动学的解法一般分两种：

我个人更偏爱解析法。虽然推导过程繁琐，但一旦写好了，跑起来又快又稳。我曾经在一个焊接机器人项目里，用解析法实现了 1kHz 的控制频率，逆运动学计算只占了不到 0.1ms 的时间。

避坑指南： 我曾经在逆运动学里忘了处理奇异位形。结果机器人在某个位置附近，关节速度突然变得极大，差点把电机烧了。记住，当机器人接近奇异位形时，逆运动学的解会变得不稳定。一定要在代码里加入奇异检测和速度限制。

下面这张图，是我自己总结的运动学知识体系。你可以把它当成一张地图，学完这一章后，对照着看看自己掌握了多少。

最后，我想说点题外话。运动学这东西，书本上写得再清楚，都不如自己动手算一遍。我建议你找个开源机器人模型（比如 KUKA 的 KR 系列），自己推导一遍 DH 参数，再写代码实现正逆运动学。

你可能会发现，推导过程中有一堆细节——比如坐标系方向的选择、关节零位的定义、奇异位形的处理——这些在教科书里往往一笔带过，但在实际项目中，每一个都是坑。

嗯，今天就到这儿。运动学是机器人控制的基石，这块搞明白了，后面的动力学、轨迹规划、自适应控制才能走得稳。咱们下节课见。