4. 运动学基础：正运动学与逆运动学、雅可比矩阵、速度与加速度约束
各位同学，欢迎来到第四章。前几章我们聊了轨迹的数学表达和插值方法，但那些都是在“理想世界”里画线。从这一章开始，我们要把轨迹和真实的机器人身体绑在一起了。
说白了，你规划出一条漂亮的曲线，但机器人能不能走到那个位置？关节该怎么转？速度会不会超限？这些问题，都得靠运动学来回答。我个人习惯把运动学看作是“机器人的翻译官”——它把任务空间的语言，翻译成关节空间的语言。
4.1 正运动学：从关节到末端
正运动学，就是已知每个关节的角度（或位移），求末端执行器在空间中的位姿。这听起来像是一个“顺理成章”的过程，但实现起来，背后是严格的几何变换。
我记得刚入行时，带我的老工程师跟我说：“你先把DH参数表给我列出来，再谈别的。”DH参数（Denavit-Hartenberg）是正运动学的基石。它用四个参数（a, α, d, θ）来描述相邻两个连杆之间的相对位置和姿态。
核心公式：正运动学本质上就是一连串齐次变换矩阵的连乘。
T_0^n = T_0^1 * T_1^2 * ... * T_{n-1}^n
其中，T_{i-1}^i 就是根据DH参数构建的4x4矩阵。
举个例子，一个简单的二连杆机械臂，你给定两个关节角度 θ1 和 θ2，通过正运动学就能算出末端点的 (x, y) 坐标。这个过程是唯一的，也是确定的。
// 伪代码：二连杆正运动学
function forwardKinematics(theta1, theta2, L1, L2) {
x = L1 * cos(theta1) + L2 * cos(theta1 + theta2);
y = L1 * sin(theta1) + L2 * sin(theta1 + theta2);
return {x, y};
}我的小习惯：在实际项目中，我很少手写DH矩阵乘法。我会用现成的库，比如 robotics-toolbox 或 Pinocchio。但理解其原理至关重要，因为调试奇异点或标定误差时，你得知道底层在算什么。
4.2 逆运动学：从末端到关节
逆运动学（IK）就反过来了：已知末端位姿，求关节角度。这比正运动学麻烦得多。为什么？因为解不唯一，甚至可能无解。
你想想看，一个六轴机器人，末端要到达空间中的某个点，手臂可以“弯着”过去，也可以“伸着”过去，这就是多解。更头疼的是，有些位姿在物理上根本到不了（比如手臂长度不够），这就是无解。
我在做焊接机器人项目时，就遇到过这个问题。明明离线仿真里轨迹跑得好好的，一上现场，机器人就报错“目标不可达”。后来排查发现，是工装夹具的安装误差导致末端位姿超出了机器人的工作空间。
避坑指南：千万不要在运行时才去检查IK是否有解。我建议在轨迹规划前，先做一次可达性预检。把目标点映射到关节空间，看看是否在关节限位内。
IK的求解方法主要有两类：
- 解析法：速度快，但只适用于特定构型的机器人（比如有球形腕的六轴机器人）。
- 数值法：通用性强，基于迭代优化（如牛顿法、雅可比伪逆法）。
我个人更偏爱解析法，只要构型允许。因为它稳定，不会像数值法那样陷入局部最优或发散。但数值法在冗余自由度机器人（比如七轴机器人）上，几乎是唯一的选择。
4.3 雅可比矩阵：速度与力的映射
雅可比矩阵 J，是连接关节空间速度 q_dot 和末端笛卡尔空间速度 v 的桥梁。
v = J(q) * q_dot
这个公式看着简单，但内涵很深。雅可比矩阵不是常数，它随着机器人构型 q 的变化而变化。当机器人处于某些特殊位形时，雅可比矩阵会“降秩”，也就是我们常说的奇异点。
奇异点有多可怕？在奇异点附近，关节速度会变得极大，甚至趋近于无穷。我记得有一次调试码垛机器人，在某个角落总是出现“关节速度超限”报警。后来一查，就是路径刚好穿过了奇异点。
关键理解：雅可比矩阵不仅映射速度，它的转置 J^T 还映射力。末端受到的力 F 和关节力矩 τ 的关系是：τ = J^T * F。这在力控和阻抗控制中极其重要。
4.4 速度与加速度约束
轨迹规划不能只考虑位置，还得考虑速度和加速度。因为机器人有物理极限：电机有最大转速，结构有最大承受加速度。
这些约束通常表现为：
- 关节空间约束：每个关节的
q_dot_max和q_ddot_max。 - 笛卡尔空间约束：末端执行器的线速度、角速度上限。
你可能会问：“我直接在关节空间规划不就行了？” 嗯，理论上可以，但实际中，我们往往需要在笛卡尔空间规划直线或圆弧轨迹，然后再通过逆运动学和雅可比矩阵，把这些约束映射回关节空间。
这里有一个常见的坑：加速度突变。即使速度是连续的，如果加速度不连续（比如从匀速直接切换到减速），就会产生冲击，导致机器人抖动或损坏减速机。所以，我一般会在轨迹中引入S形速度曲线，保证加速度也是连续的。
我的经验：在做高速拾取任务时，我会把加速度约束放在第一位。因为速度超限通常只会影响节拍，但加速度超限会直接触发伺服报警，甚至损坏机械结构。安全第一。
4.5 知识体系总览
为了让你更直观地理解本章的知识结构，我画了一张图。它展示了从任务空间到关节空间的映射关系，以及雅可比矩阵在其中扮演的“桥梁”角色。
从这张图你可以看到，正逆运动学解决的是“位置”层面的映射，而雅可比矩阵则负责“速度/力”层面的映射。所有的规划，最终都要落到关节空间的约束框内。
4.6 本章小结
这一章的内容，是后续所有轨迹规划算法的“物理基础”。没有运动学，你规划的轨迹就是空中楼阁。
- 正运动学：唯一映射，是基础工具。
- 逆运动学：多解、无解、奇异点，是工程中的主要挑战。
- 雅可比矩阵：连接速度与力的桥梁，也是分析奇异点的关键。
- 速度/加速度约束：把物理极限纳入规划，保证轨迹可执行。
嗯，这一章就到这里。记住，运动学不是纯数学，它是你和机器人沟通的语言。把这一章吃透，后面讲轨迹优化、时间最优规划时，你才能游刃有余。