Keyboard shortcuts

Press ← or → to navigate between chapters

Press S or / to search in the book

Press ? to show this help

Press Esc to hide this help

全章总结

八节一览

节关键结论典型陷阱
3.1 几何雅可比ve=J(q)q˙v_e=J(q)\dot q（定义 3.1.1）；R˙=SR\dot R=SR、S=S(ω)S=S(\omega)（定理 3.1.A、定义 3.1.2）；三项速度合成与两条递推；逐列构造（定理 3.1.C）zi−1z_{i-1} 当 [0,0,1]T[0,0,1]^{\mathrm T}；牵连项写错 ω\omega
3.2 典型结构五步流水线（方法 3.2.A）；三连杆平面臂；拟人臂取有效块 det⁡Jˉ=−a2a3s3(a2c2+a3c23)\det\bar J=-a_2a_3s_3(a_2c_2+a_3c_{23})；斯坦福第 3 列取移动列斯坦福第 3 列取转动；拟人臂忘 z1≠z0z_1\neq z_0
3.3 运动学奇点det⁡J=0\det J=0（定义 3.3.1）；三类后果；边界 / 内部；例 3.2 det⁡J=a1a2s2\det J=a_1a_2s_2；解耦 det⁡J=det⁡J11det⁡J22\det J=\det J_{11}\det J_{22}（定理 3.3.A）→ 腕 s5s_5、肘 s3s_3、肩腕点落轴解耦矩阵拿去传速度；把奇点当数值 bug
3.4 冗余分析冗余任务相关 n>rn>r（定义 3.4.1）；P=NNTP=NN^{\mathrm T}；解族 q˙∗+Pq˙0\dot q^*+P\dot q_0（定理 3.4.B）用 mm 代替 rr；JJ 忘按任务取行
3.5 逆微分运动学方阵逆 + 数值积分；拉格朗日 ⇒ J†=JT(JJT)−1J^\dagger=J^{\mathrm T}(JJ^{\mathrm T})^{-1}（定义 3.5.1）；q˙=J†ve+(I−J†J)q˙0\dot q=J^\dagger v_e+(I-J^\dagger J)\dot q_0；DLS 与 J∗J^*（定义 3.5.2）J†J^\dagger 与 J−1J^{-1} 混用；忘 JW−1JTJW^{-1}J^{\mathrm T} 可逆前提
3.6 分析雅可比ωe=T(φ)φ˙\omega_e=T(\varphi)\dot\varphi；JA=TA−1JJ_A=T_A^{-1}J（定理 3.6.A）；TT 奇点 = ZYZ 歧义；φ˙\dot\varphi 可积、ω\omega 不可积拿 JAJ_A 当 JJ；忘 TT 失效
3.7 逆运动学算法逆方案 q˙=JA−1(x˙d+Ke)\dot q=J_A^{-1}(\dot x_d+Ke)（完全线性化）；转置方案 JTKeJ^{\mathrm T}Ke（省计算、Lyapunov）；二阶算法 e¨+KDe˙+KPe=0\ddot e+K_D\dot e+K_Pe=0转置方案按线性设计；忽略 J˙\dot J
3.8 静力学τ=JTFe\tau=J^{\mathrm T}F_e（虚功原理，定义 3.8.1）；速度 / 力变换转置对偶（3.8.2）用 J−1J^{-1} 传力；力的坐标系未统一

一条主线

位姿运动学 xe=k(q)x_e=k(q) 是非线性谜题；对它求导，谜题变成线性代数——雅可比 JJ 登场（3.1–3.2）。线性代数有两种病：退化（奇点，3.3）与欠定（冗余，3.4）。病理学之后是治疗学：逆微分运动学按 JJ 的形状分三种解法（3.5），φ˙\dot\varphi 与 ω\omega 的换基给出分析雅可比（3.6），把误差当速度输入就得到逆运动学数值算法（3.7）。最后，JJ 的转置把末端力映射回关节力矩——静力学（3.8），运动学与静力学的对偶至此闭环。

三句话带走

  1. 雅可比的列 = 单关节的贡献：其余关节锁死、只动第 ii 个关节，末端速度就是 Jiq˙iJ_i\dot q_i——转动列 [zi−1×(pe−pi−1); zi−1][z_{i-1}\times(p_e-p_{i-1});\ z_{i-1}]、移动列 [zi−1; 0][z_{i-1};\ 0]，全部从 DH 正运动学的 TT 矩阵读取。
  2. 不方阵的三种病分别有药：方阵满秩求逆；矮胖（冗余）用 J†J^\dagger + 零空间项 q˙0\dot q_0；退化（奇点）用解耦判 det⁡J11det⁡J22\det J_{11}\det J_{22}、用 DLS 阻尼换可解性。
  3. JJ 也是力学的桥：τ=JTFe\tau=J^{\mathrm T}F_e 来自虚功原理——速度变换的转置就是力变换，这对偶贯穿静力学与力控制。

依据 Siciliano 等《机器人学：建模、规划与控制》第 3 章整理 · 整合第 3 周课程录播 · 整理日期 2026-09-24

全 章 完