4、运动学基础：刚体运动描述、平移与旋转、速度与加速度、雅可比矩阵概念
各位同学，欢迎来到运动学基础这一章。
说实话，搞机器人轨迹规划，运动学就是你的“内功心法”。你想想看，如果连机器人怎么动、动多快、力怎么传都搞不清楚，那后面的轨迹规划、避障、控制，全都是空中楼阁。我个人习惯，在搭建仿真系统之前，先把运动学这层地基夯实了。
这一章，我们就来聊聊刚体运动描述、平移与旋转、速度与加速度，还有那个让很多人头疼的雅可比矩阵。别怕，我会用我踩过的坑，帮你把这些概念串起来。
4.1 刚体运动描述：位置与姿态
什么是刚体？说白了，就是理想化的物体——不管你怎么推、怎么拉，它自己不会变形。机器人连杆、末端执行器，我们通常都当作刚体处理。
描述一个刚体在空间中的状态，需要两样东西：位置和姿态。合起来叫位姿。
- 位置：用三维坐标 (x, y, z) 表示。比如末端在空间哪个点。
- 姿态：用旋转矩阵、欧拉角或四元数表示。比如末端朝哪个方向。
我在项目中遇到过一个问题：只记录了位置，没记录姿态，结果机器人抓取时，夹爪直接怼到了工件侧面。嗯，从那以后，我所有数据结构里，位姿一定是成对出现的。
4.2 平移与旋转：刚体运动的“两板斧”
刚体运动只有两种基本形式：平移和旋转。任何复杂的运动，都可以拆解成这两者的组合。
4.2.1 平移运动
平移就是整体挪个地方，方向不变。用平移向量描述。比如，把末端从A点移到B点，向量就是B - A。
在齐次坐标下，平移变换就是一个4x4的矩阵，左上角是单位阵，右上角是平移向量。
// 齐次平移矩阵示例 (沿x轴移动dx, y轴移动dy, z轴移动dz)
T = [1, 0, 0, dx;
0, 1, 0, dy;
0, 0, 1, dz;
0, 0, 0, 1 ]4.2.2 旋转运动
旋转就稍微复杂一点。绕不同轴转，结果不一样。最常用的是旋转矩阵，它是一个3x3的正交矩阵，行列式为+1。
绕x轴、y轴、z轴旋转θ角度的矩阵，大家一定要烂熟于心。我刚开始学的时候，总是搞混正负号，后来自己推导了一遍，才彻底记住。
| 旋转轴 | 旋转矩阵 R(θ) |
|---|---|
| 绕 x 轴 | [1, 0, 0; 0, cosθ, -sinθ; 0, sinθ, cosθ] |
| 绕 y 轴 | [cosθ, 0, sinθ; 0, 1, 0; -sinθ, 0, cosθ] |
| 绕 z 轴 | [cosθ, -sinθ, 0; sinθ, cosθ, 0; 0, 0, 1] |
4.3 速度与加速度：从静态到动态
光知道位置和姿态还不够，机器人要动起来，就得谈速度和加速度。
- 线速度 v：位置对时间的导数。单位 m/s。
- 角速度 ω：姿态对时间的导数。单位 rad/s。
- 线加速度 a：线速度对时间的导数。
- 角加速度 α：角速度对时间的导数。
这里有个容易混淆的点：角速度并不是某个角度的简单导数。它是个向量，方向沿着瞬时旋转轴，大小是旋转速率。我在做仿真时，曾经直接用欧拉角的导数当角速度，结果算出来的动力学模型完全不对。后来查资料才发现，角速度和欧拉角导数之间，存在一个变换矩阵。
4.4 雅可比矩阵概念：速度与力的“翻译官”
雅可比矩阵，是本章的重头戏，也是很多人的噩梦。但说白了，它就是一个线性映射。
在机器人学里，雅可比矩阵 J 把关节空间的速度（关节角速度）映射到操作空间的速度（末端线速度和角速度）。
公式很简单：ẋ = J · q̇
- ẋ：末端速度向量 (6x1)，包含线速度和角速度。
- q̇：关节速度向量 (n x 1)，n是关节数。
- J：雅可比矩阵 (6 x n)。
雅可比矩阵还有另一个重要应用：力映射。根据虚功原理，末端力 F 和关节力矩 τ 的关系是：τ = Jᵀ · F。
你看，同一个矩阵，既管速度，又管力。这就是它的神奇之处。
4.4.1 雅可比矩阵的几何意义
雅可比矩阵的每一列，代表对应关节的单位速度对末端速度的贡献。比如，第一列就是关节1以单位速度运动时，末端的瞬时速度。
我习惯在仿真中，把雅可比矩阵的列向量可视化出来。这样能直观看到每个关节对末端运动的“贡献方向”。
4.4.2 奇异性
当雅可比矩阵不满秩时，机器人处于奇异位形。这时候，末端在某些方向上会失去运动能力，或者关节速度会变得极大。
我曾经在调试一个六轴机器人时，轨迹规划到某个点，关节速度突然飞了。一查，原来是雅可比矩阵接近奇异，逆解不稳定。从那以后，我的轨迹规划里一定会加一个“远离奇异点”的约束。
4.5 本章知识体系图
为了帮你把这一章的知识点串起来，我画了一张图。你可以看到，从刚体位姿出发，通过微分得到速度，再通过雅可比矩阵，把关节和末端联系起来。
嗯，这一章的内容就到这里。运动学是机器人学的基石，雅可比矩阵更是贯穿轨迹规划、动力学、控制的“万能钥匙”。希望你能亲手推导一遍旋转矩阵，再写个小程序算算雅可比。相信我，动手之后，这些概念才能真正变成你自己的。