机器人入行指南
原理层/雅可比:关节转一度,末端动多少

原理层 T9 / 27 · 线代与几何

雅可比:关节转一度,末端动多少

雅可比是「每个关节动一点,末端跟着动多少」的换算表——多变量链式法则排成矩阵。速度控制、力控、奇异位形分析,全从这一张表里读出来。

好位形 θ₂=90°·|det J| = 1.0 全方向可达·末端速度椭球饱满·逆解关节速度温和伸直 θ₂→0·|det J| → 0 奇异塌缩·某方向完全够不着·逆解所需速度发散vs顺序不可换雅可比行列式只由肘角决定:手伸得越直,某个方向越「够不着」,逆解关节速度发散——这就是奇异位形
约 45 分钟3 定理7 步证明4 题自测

一句话结论

二连杆机械臂,你转肩关节 1°、肘关节 2°,末端(笔尖)走了多少?往哪个方向?——这不是一个数字,是一张 2×2 的偏导数表:x 对 θ1 的敏感度、x 对 θ2 的敏感度、y 对 θ1 的、y 对 θ2 的。这张表就是雅可比 J。机器人每秒一千次地算它、用它、检查它什么时候失灵。

动图版 · 拖机械臂关节改姿势,|det J| 实时塌缩——伸太直的那一刻就是奇异位形

前面六座桥里你已经会:单变量的导数(斜率→梯度)。现在是两个变量决定两个输出——导数升级为「表」,这张表就是雅可比。它几乎是机器人学出场率最高的矩阵:速度传递、力映射、奇异性、最小二乘求逆,全都经它之手。

为什么需要它

高中生完全够用:偏导数 = 固定其他变量,只让一个变量动一点点,看输出动多少。你不需要「学完多元微积分」才能读——本篇就用一个二连杆把它算全。

定义

定义 3.1 偏导数(直观版)

f(x_1, …, x_n) 对 x_i 的偏导数 ∂f/∂x_i:固定其他所有变量,只让 x_i 增加一点点,看 f 动了多少的比例。就是「单变量导数」,只是每次只放开一个旋钮。

定义 3.2 雅可比矩阵

m 个输出 f_1…f_m、n 个输入 x_1…x_n 的系统,雅可比 J 是 m×n 矩阵,(i,j) 元 = ∂f_i/∂x_j。第 i 行 = 输出 f_i 对全部输入的敏感度;第 j 列 = 输入 x_j 单独动时所有输出的反应。本篇的机械臂:输入 (θ1, θ2),输出 (x, y),J 是 2×2。

定义 3.3 奇异位形

det J = 0 的关节角组合。此刻雅可比把某个方向「压扁」——存在关节速度组合使末端速度为零,也存在末端方向使任何关节速度都够不着。机械臂在奇异位形附近失控、抖动、驱动器过载,全是这一行行列式的锅。

定理与证明

定理 3.1 链式法则的矩阵形式

若 z = g(y)、y = h(x),则复合映射的雅可比 J_z|_x = J_z|_y · J_y|_x——雅可比沿链条相乘。

证

按分量验证一维核心情形即可推广:z = g(h(x)),微小扰动 δx 使 y 动 δy = h′(x)δx,进而 z 动 δz = g′(y)δy = g′(h(x))·h′(x)·δx。

比例系数 g′(h(x))·h′(x) 正是两个导数的乘积——对应矩阵形式 J_z J_y。多输入时每一对 (输出, 输入) 都按同样道理贡献一个偏导,排成矩阵恰好是矩阵乘法的 (i,j) 元定义。∎

注和 T8 的结合律是同一件事:变换串联,记账矩阵相乘。运动学链(基→肩→肘→腕)的微分版本就是一串雅可比相乘。

定理 3.2 二连杆的雅可比与行列式

两杆长 l_1 = l_2 = 1,末端 (x, y) = (cos θ1 + cos(θ1+θ2), sin θ1 + sin(θ1+θ2))。则 J = [[−sin θ1 − sin(θ1+θ2), −sin(θ1+θ2)], [cos θ1 + cos(θ1+θ2), cos(θ1+θ2)]],且 det J = sin θ2。

证

x 对 θ1 求偏导(θ2 固定):∂x/∂θ1 = −sin θ1 − sin(θ1+θ2)。x 对 θ2:−sin(θ1+θ2)。y 同理用 cos。

det J 按定义展开:[−sin θ1 − sin(θ1+θ2)]·cos(θ1+θ2) − [−sin(θ1+θ2)]·[cos θ1 + cos(θ1+θ2)]。

展开合并:= −sin θ1 cos(θ1+θ2) + sin(θ1+θ2) cos θ1 = sin(θ1+θ2 − θ1) = sin θ2(两角和正弦公式,高中内容)。∎

注结果干净得惊人的原因:det J = sin θ2 只依赖肘部夹角。肩角 θ1 只决定「臂膀朝哪」,不影响「伸多直」——奇异位形完全由肘角决定。

定理 3.3 速度传递与奇异性

末端速度 v = J q̇(q̇ 是关节角速度向量)。det J ≠ 0 时 J 可逆,任何末端速度都能由某组关节速度实现;det J = 0 时存在「够不着」的方向,且需要的关节速度趋于无穷。

证

对位姿方程求时间的全导数,每个偏导数按链式法则贡献一项:ẋ = (∂x/∂θ1)θ̇1 + (∂x/∂θ2)θ̇2,ẏ 同理——排成矩阵即 v = J q̇。这是「微小扰动一阶近似」的直接推论。

det J = sin θ2(定理 3.2)。θ2 → 0 或 π 时 det J → 0:J 的逆不存在。想沿「被压扁的方向」走,逆解需要的 q̇ 按 1/|det J| 速度增长,趋于无穷——这就是奇异位形附近机械臂狂转、电机过流的原因。∎

注工程口诀:手伸得越直,转向越费劲。人手臂伸直去拿侧后方的东西会「别扭」,机械臂在同一位置是数值爆炸。规划器绕开奇异位形,不是怕慢,是怕失控。

手算一遍

l_1 = l_2 = 1,θ1 = 30°,θ2 = 60°。求 J 与 det J;若关节速度 q̇ = (0.5, −0.5) rad/s,末端速度多大?

  1. θ1 + θ2 = 90°。sin θ1 = 0.5,cos θ1 = √3/2 ≈ 0.866;sin 90° = 1,cos 90° = 0。
  2. [object Object]
  3. det J = (−1.5)(0) − (−1)(0.866) = 0.866 = sin 60° ✓(与定理 3.2 一致)。
  4. [object Object]
  5. 末端速度大小 = √(0.25² + 0.433²) = 0.5 m/s。方向偏 y 正向——肩正转肘反转,末端在「横着扫」。
答

J = [[−1.5, −1], [0.866, 0]],det J = 0.866,末端速度 0.5 m/s 指向 (−0.25, 0.433) 方向。整条计算只用了三角函数和乘法——雅可比不难,难的是每一步知道自己在算什么。

实跑一遍

数字出处

生成时实跑(l_1 = l_2 = 1):

  • θ2 = 90° 时 |det J| = 1.000——操作度最好的肘角
  • θ2 = 10-6 rad(几乎伸直)时 |det J| = 1.0e-6——塌缩了六个数量级
  • 逆解所需关节速度按 1/|det J| 增长:同一末端速度,伸直位形需要的关节速度是好位形的百万倍级

映射回强化学习

这里的对象RL 里的对应物站内用法
速度控制笛卡尔速度指令 → 关节速度:q̇ = J−1 v用法 →
力控末端力 → 关节力矩:τ = J^T F(对偶关系)用法 →
策略梯度RL 里「动作对参数的敏感度表」就是梯度,雅可比的特例用法 →

边界:这一篇停在哪里

本篇停在哪里:只做 2×2。空间机械臂的 6×6 广义雅可比(含浮动基座)、可操作度椭球的完整理论、冗余臂的零空间投影都不展开——但 2×2 版的每一个结论(v = J q̇、τ = J^T F、det J 塌缩)在高维逐字成立。

自测 4 题

全是手算和「找证明错在哪」类题目,不出背诵题。答不上来回到对应小节。

01雅可比的 (i,j) 元是什么物理量?

第 j 个关节单位角速度引起第 i 个输出(如末端 x 坐标)的变化速率。整张表 = 「关节小动 → 末端怎么动」的完整敏感度账。

02奇异位形为什么危险?

det J → 0:J 不可逆。想沿被压扁的方向给末端速度,逆解关节速度按 1/|det J| 发散——电机过流、数值爆炸、控制发散。

03力控为什么用 J^T?

虚功原理的对偶:速度映射 v = J q̇,则力映射反着走 τ = J^T F。同一个矩阵,转置一下,速度表变力表。

04偏导数和高中导数什么关系?

同一个东西:固定其他变量、只放一个旋钮,看输出变化比例。高中导数是 n=1 特例,偏导数是每次只开一个旋钮的版本,没有任何新数学工具。

接着看

全系列 27 篇

T1矩阵就是旋转的记账本约 25 分钟T2从斜率到梯度:机器人学习算法的第一行约 25 分钟T3向量与受力:点积的物理读法约 20 分钟T4两把尺子和一把更好的尺子约 25 分钟T5电机转一圈的账:弧度、转速与功率约 20 分钟T6复数乘法就是旋转:四元数的一维版约 20 分钟T7基与坐标:为什么机器人什么都用矩阵约 45 分钟T8矩阵乘法:变换的串联,不是表格运算约 40 分钟T9雅可比:关节转一度,末端动多少约 45 分钟T10特征向量:矩阵不敢动的方向约 45 分钟T11SVD 与伪逆:没有精确解时,找最近的解约 50 分钟T12泰勒展开:用直线替曲线打工约 40 分钟T13概率空间:为什么「随机」需要公理约 50 分钟T14期望:「平均」的严格构造约 55 分钟T15条件期望:竖线的真正含义约 60 分钟T16四个不等式:「多少样本才够」的定量答案约 45 分钟T17范数与不动点:「一定收敛」的出处约 55 分钟T18马尔可夫链:时间平均何时等于集合平均约 55 分钟T19MDP 的数学构造:一条公理值多少钱约 50 分钟T20动态规划:两种迭代的账约 50 分钟T21优化:约束为什么不能只靠罚约 55 分钟T22随机逼近:学习率公式里的每一条约 55 分钟T23接触的数学:Hertz 理论约 45 分钟T24摩擦与摩擦锥:约束的几何形状约 40 分钟T25力封闭与抓取度量:ε 是一个线性规划约 50 分钟T26接触运动学:滚动为什么不是「贴着滑」约 45 分钟T27滑移检测:从「感觉到了」到「算出来了」约 50 分钟