087、机器人运动学：雅可比矩阵
一、一个让我熬夜三天的调试故事
去年做六轴协作机器人末端力控的时候，遇到一个诡异的问题：机器人末端在某个位姿下，明明关节速度指令给得很平滑，末端速度却突然跳变，导致力控震荡。当时我盯着示波器上的速度曲线，百思不得其解——运动学正解算出来的位置明明连续，速度怎么就炸了？
后来用MATLAB把雅可比矩阵的条件数实时打印出来，才发现那个位姿下矩阵接近奇异，末端速度在某个方向上的映射几乎失效。这个坑让我意识到：雅可比矩阵不是教科书里冷冰冰的数学符号，它是机器人运动学里最“物理”的东西——直接决定了关节空间到任务空间的“传动效率”。
二、雅可比矩阵到底在算什么？
先别急着翻公式。想象你握着机器人的末端，想让它沿着X方向移动1毫米。这时候六个关节各自要转多少？如果每个关节转1度，末端移动的距离肯定不一样——有的关节离末端远，力臂长，贡献大；有的关节轴线方向跟移动方向垂直，转再多也没用。
雅可比矩阵就是干这个的：它把关节速度映射到末端速度。数学上写成：
v = J(q) * q_dotv是末端速度（包含线速度和角速度，6维向量），q_dot是关节速度（n维向量，n是关节数），J是6×n的矩阵。
关键理解：雅可比矩阵的每一列，对应某个关节单位速度引起的末端速度。比如第i列，就是关节i以1 rad/s转动时，末端产生的速度向量。
