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

综合自测卷 · 第三章

用途:在学完八节之后,检验自己是否真的掌握了第三章。请计时、闭卷、独立完成——查书或看解答做出来的分数没有意义。

建议用时:110 分钟 · 满分 100 分。本章按考试权重分两块:3.1–3.2(几何雅可比)与 3.8(静力学)是必考,3.3 / 3.5 是精读,3.4 / 3.6 是了解,3.7 不考细节——做卷时不必平均用力。做完后对照文末评分标准给自己打分,再用学习目标自检表反查到正文薄弱小节。

使用说明

本卷题目绝大多数为新增。第 16 题与习题 B1(共轭恒等式)同族、第 17 题与习题 B2(拟人臂雅可比与奇点)同族——这两处有意保留:它们分别是本章「最常被考」与「最容易算错」的两处判据,隔一段时间再做一次正好检验是否真的会用。第 18 题(两连杆臂数值)与习题 C1 思路相近但换了机构与数值,请独立重算。解答默认折叠,便于自测。若某题完全无从下手,先做后面的题;全部做完后再回看。

第一部分 · 概念判断(10 题 × 3 分 = 30 分)

判断对错,并给出一句话理由或反例。只写「对 / 错」不得分。

1. 几何雅可比 JJ 是位形 q\boldsymbol q 的函数;把 q˙\dot{\boldsymbol q} 映射到末端速度时,ωe\boldsymbol\omega_e 的三个分量是末端角速度在基坐标系三根轴上的投影。

2. S(ω)p≡ω×pS(\boldsymbol\omega)\boldsymbol p\equiv\boldsymbol\omega\times\boldsymbol p,所以 S(ω)S(\boldsymbol\omega) 有 9 个独立元素。

3. 雅可比矩阵的行对应关节、列对应操作空间的速度分量,因此「哪两列线性相关」等价于「哪两个关节轴平行」。

4. 运动学奇点只出现在可达工作空间的边界上,因此只要把工作点选在内部就永远不会遇到奇点。

5. 拟人臂的肩奇点 a2c2+a3c23=0a_2c_2+a_3c_{23}=0 发生时,JJ 的第一列整列为零,此时逆解有无穷多组。

6. 奇点解耦得到的下三角矩阵——即 det⁡J=det⁡J11det⁡J22\det J=\det J_{11}\det J_{22}——可以拿去做逆解,因为它保留了 JJ 的全部信息。

7. 冗余机械手用 J†J^\dagger 解出的 q˙=J†ve\dot{\boldsymbol q}=J^\dagger\boldsymbol v_e 是满足任务约束的最小范数解;再加上 (I−J†J)q˙0(I-J^\dagger J)\dot{\boldsymbol q}_0 之后,末端速度仍然不变。

8. 力从末端传到关节要用 J−1J^{-1}:既然速度满足 ve=Jq˙\boldsymbol v_e=J\dot{\boldsymbol q},力的关系就应当是把同一条式子反过来解。

9. 分析雅可比 JAJ_A 与几何雅可比 JJ 的区别只出现在姿态部分;两者在欧拉角歧义处(sϑ=0s_\vartheta=0)同时失效,是同源问题。

10. 雅可比转置方案 q˙=JTKe\dot{\boldsymbol q}=J^{\mathrm T}K\boldsymbol e 与逆雅可比方案 q˙=JA−1(x˙d+Ke)\dot{\boldsymbol q}=J_A^{-1}(\dot{\boldsymbol x}_d+K\boldsymbol e) 都能把误差动态化成 e˙=−Ke\dot{\boldsymbol e}=-K\boldsymbol e 那样的一阶线性系统。

第一部分答案(每题 3 分:判断 1 分 + 理由 2 分)

(1) 对。 JJ 是位形的函数(J(q)J(\boldsymbol q)),ve=[p˙eωe]=J(q)q˙\boldsymbol v_e=\begin{bmatrix}\dot{\boldsymbol p}_e\\ \boldsymbol\omega_e\end{bmatrix}=J(\boldsymbol q)\dot{\boldsymbol q};而 ωe\boldsymbol\omega_e 的三个分量定义为末端角速度在基坐标系三根轴上的投影。这一句正是几何 / 分析雅可比分歧的根源:换到欧拉角的非正交瞬时轴上读数,就得到 JAJ_A。(定义 3.1.1、3.6.1)

(2) 错。 S(ω)S(\boldsymbol\omega) 有 9 个元素,但受反对称约束(对角线为零、非对角镜像反号)——独立元素恰为 3 个,与 ω\boldsymbol\omega 的 3 个分量一一对应。老师原话是「一对一的映射关系,可以类比,但不完全一样」:SS 与 RR 都是「省参数」的表示(各自 3 个独立量),但不是同一个对象。(定义 3.1.2)

(3) 错——两者说反了。 行对应操作空间的速度分量,列对应关节(老师 0:21:46 专门交代)。所以正确的说法是「哪两列线性相关 ⇔ 哪两个关节轴平行 / 共线」——这是奇点的几何机制;而行的相关性说的是「哪些速度分量相互耦合、可以只取有效行」。(3.3.1、3.2.2)

(4) 错。 奇点分两类:边界奇点(臂完全伸出 / 缩回,抵达工作空间边界,「不表示真正的缺陷」)与内部奇点(出现在可达工作空间内部,产生条件是两个或以上运动轴线共线,「比较严重」,轨迹规划时一定要避开)。所以「选在内部」正是内部奇点所在的地方——正确说法是两条都要核:内部奇点靠规划绕开,边界奇点靠避开边界。(3.3.1)

(5) 对。 肩奇点的几何含义是腕中心恰好落在 z0z_0 轴上(pw\boldsymbol p_w 的 x,yx,y 分量为零),此时 JJ 的第一列 z0×(pw−p0)=z0×pw=0z_0\times(\boldsymbol p_w-\boldsymbol p_0)=z_0\times\boldsymbol p_w=\boldsymbol 0 整列为零——无论肩关节转多快,腕点纹丝不动;相应地逆运动学无穷多解(ϑ1\vartheta_1 任取)。(3.3.3)

(6) 错。 解耦矩阵只保行列式、用于奇点分析;它不再提供关节速度与末端执行器速度之间的关系(参考点已从末端挪到腕心),因此不能拿去做逆解或速度控制。合法性来源:运动学奇点是机械结构固有特性、与坐标系建在哪里无关,所以可以为了简化计算而重选参考系——但做完判断必须换回末端参考。(定理 3.3.A 的适用边界)

(7) 对。 J†veJ^\dagger\boldsymbol v_e 是满足 ve=Jq˙\boldsymbol v_e=J\dot{\boldsymbol q} 的最小范数解(「干活用的」);第二项 (I−J†J)q˙0(I-J^\dagger J)\dot{\boldsymbol q}_0 是齐次解:J(I−J†J)q˙0=(J−J)q˙0=0J(I-J^\dagger J)\dot{\boldsymbol q}_0=(J-J)\dot{\boldsymbol q}_0=0,故它对末端速度的贡献恒为零——这正是「不惊动末端的内部运动」,用来做再配置(提高灵巧性、避障、回避奇异、远离关节极限)。(定义 3.5.1、3.5.1)

(8) 错。 力变换是 JTJ^{\mathrm T}(对偶),不是求逆——τ=JTFe\boldsymbol\tau=J^{\mathrm T}F_e 来自虚功原理 / 功率守恒:q˙Tτ=veTFe=(Jq˙)TFe=q˙TJTFe\dot{\boldsymbol q}^{\mathrm T}\boldsymbol\tau=\boldsymbol v_e^{\mathrm T}F_e=(J\dot{\boldsymbol q})^{\mathrm T}F_e=\dot{\boldsymbol q}^{\mathrm T}J^{\mathrm T}F_e 对任意 q˙\dot{\boldsymbol q} 成立。两条纪律:JJ 是长方阵时 JTJ^{\mathrm T} 照样可用(无需方阵、无需满秩);FeF_e 与 JJ 必须在同一坐标系下。(定义 3.8.1、3.8.1)

(9) 对。 JA=TA−1JJ_A=T_A^{-1}J 中 TA=[I300T(φe)]T_A=\begin{bmatrix}I_3&0\\0&T(\boldsymbol\varphi_e)\end{bmatrix}——左上角的 I3I_3 说明线速度部分两式一致,右下角的 TT 说明角速度部分要换算。ZYZ 的表示奇点(ϑ=0,π\vartheta=0,\pi,进动轴与自转轴重合)使 TT 的第 1、3 列共线、TT 奇异,于是 JAJ_A 也失去定义——两者同源。(定理 3.6.A、3.6.3)

(10) 错。 只有逆方案能把误差动态化成 e˙=x˙d−JAq˙=x˙d−(x˙d+Ke)=−Ke\dot{\boldsymbol e}=\dot{\boldsymbol x}_d-J_A\dot{\boldsymbol q}=\dot{\boldsymbol x}_d-(\dot{\boldsymbol x}_d+K\boldsymbol e)=-K\boldsymbol e(完全线性化);转置方案的误差动态是非线性的——多出含 JJ 随位形变化的项,稳定性只能借助 Lyapunov 函数分析,收敛只是局部的。代价换收益:转置省去了求逆(「J−1J^{-1} 很花时间;用 JTJ^{\mathrm T} 直接调换一下元素位置就可以了」)。(3.7.1、3.7.2)

第二部分 · 填空简答(5 题 × 4 分 = 20 分)

11.(4 分) 写出从 RRT=IRR^{\mathrm T}=I 到 R˙=S(ω)R\dot R=S(\boldsymbol\omega)R 的推导链(三步),并说明「SS 就是角速度」这一步用的是哪两个物理事实。

12.(4 分) 写出几何雅可比的逐列构造(绿框)——转动关节列与移动关节列各是什么,并把每一列所需的量指到正运动学的哪一部分。

13.(4 分) 写出六轴臂奇点解耦的矩阵形式与三个具体奇点条件,并说明这个技巧的合法性来源。

14.(4 分) 写出处理 JJ 的三种「形状」各自该用的工具(含公式),并写出它们共同的可逆性前提。

15.(4 分) 写出逆微分运动学用于逆运动学数值算法时的两条路线(含公式)与各自的误差动态特点。

第二部分答案(每题 4 分)

11. 三步推导链:① 由 RRT=IRR^{\mathrm T}=I 两边求导并用乘积法则 ⇒ R˙RT+RR˙T=0\dot RR^{\mathrm T}+R\dot R^{\mathrm T}=0;② 记 S≜R˙RTS\triangleq\dot RR^{\mathrm T},则 S+ST=0S+S^{\mathrm T}=0——SS 反对称;③ 两边右乘 RR 把 R˙\dot R 单独解出来 ⇒ R˙=S R\dot R=S\,R。识别 SS 的两个物理事实:(a) 对常模向量 p(t)=R(t)p′\boldsymbol p(t)=R(t)\boldsymbol p' 求导,得 p˙=SRp′\dot{\boldsymbol p}=S R\boldsymbol p';(b) 力学给随坐标系一起转动的点线速度 p˙=ω×p=ω×Rp′\dot{\boldsymbol p}=\boldsymbol\omega\times\boldsymbol p=\boldsymbol\omega\times R\boldsymbol p'。两式对任意 p′\boldsymbol p' 成立 ⇒ SR=S(ω)RS R=S(\boldsymbol\omega)R。评分:三步 2 分;两个事实与比较过程 2 分。(定理 3.1.A、定义 3.1.2)

12. 转动关节:JPi=zi−1×(pe−pi−1)J_{P_i}=z_{i-1}\times(\boldsymbol p_e-\boldsymbol p_{i-1})、JOi=zi−1J_{O_i}=z_{i-1};移动关节:JPi=zi−1J_{P_i}=z_{i-1}、JOi=0J_{O_i}=\boldsymbol 0(课件用 σi\sigma_i 区分:转动 σi=0\sigma_i=0、移动 σi=1\sigma_i=1)。量的出处:zi−1=Ri−1z_{i-1}=R_{i-1}(即 Ti−10T_{i-1}^0 的左上 3×33\times3 块)的第三列;pi−1\boldsymbol p_{i-1} = Ti−10T_{i-1}^0 第四列前三行;pe\boldsymbol p_e = Tn0T_n^0 第四列前三行。物理解读:其余关节全部锁死、只以单位速度驱动第 ii 个关节,末端产生的速度就是第 ii 列。评分:两式 2 分;出处 1.5 分;物理解读或「zi−1z_{i-1} 不是 [0,0,1]T[0,0,1]^{\mathrm T}」的提醒 0.5 分。(定理 3.1.C)

13. 把参考点从末端挪到腕心 pw\boldsymbol p_w,得下三角分块 [p˙wωe]=[J110J21J22][q˙aq˙w]\begin{bmatrix}\dot{\boldsymbol p}_w\\ \boldsymbol\omega_e\end{bmatrix}=\begin{bmatrix}J_{11}&0\\ J_{21}&J_{22}\end{bmatrix}\begin{bmatrix}\dot{\boldsymbol q}_a\\ \dot{\boldsymbol q}_w\end{bmatrix},det⁡J=det⁡J11det⁡J22\det J=\det J_{11}\det J_{22}。三个条件:腕奇点 det⁡J22∝s5\det J_{22}\propto s_5 ⇒ ϑ5=0,π\vartheta_5=0,\pi(内部奇点);肘奇点 s3=0s_3=0(边界奇点);肩奇点 a2c2+a3c23=0a_2c_2+a_3c_{23}=0。合法性来源:运动学奇点是机械结构固有的特性,与坐标系建在哪里无关——所以完全可以为了简化计算而重新选参考系(取在腕心),使 J12=0J_{12}=0。评分:矩阵与判定式 1.5 分;三个条件 1.5 分;合法性来源 1 分。(定理 3.3.A)

14.

形状 工具 公式
方阵满秩 J−1J^{-1} + 数值积分 q(tk+1)≈q(tk)+J−1(q(tk))ve(tk)Δt\boldsymbol q(t_{k+1})\approx\boldsymbol q(t_k)+J^{-1}(\boldsymbol q(t_k))\boldsymbol v_e(t_k)\Delta t
冗长(r<nr&lt;n) 右伪逆 + 零空间项 q˙=J†ve+(I−J†J)q˙0\dot{\boldsymbol q}=J^\dagger\boldsymbol v_e+(I-J^\dagger J)\dot{\boldsymbol q}_0,J†=JT(JJT)−1J^\dagger=J^{\mathrm T}(JJ^{\mathrm T})^{-1}
退化(奇异) 阻尼最小二乘 J∗=JT(JJT+k2I)−1J^{*}=J^{\mathrm T}(JJ^{\mathrm T}+k^2I)^{-1}(W=I,K=k2IW=I,K=k^2I)

共同的可逆性前提:JW−1JTJW^{-1}J^{\mathrm T} 可逆 ⇔ JJ 行满秩(无奇异)——JJ 与 WW 都满秩时,左右相乘相当于初等变换、不改变秩。DLS 为什么例外:JW−1JT+K−1JW^{-1}J^{\mathrm T}+K^{-1} 因 K−1K^{-1} 项在奇异时仍可逆,这正是它治奇点的机制。评分:三格各 1 分;可逆性前提 1 分。(3.5.1、3.5.2)

15. 逆雅可比方案:q˙=JA−1(q)(x˙d+Ke)\dot{\boldsymbol q}=J_A^{-1}(\boldsymbol q)\big(\dot{\boldsymbol x}_d+K\boldsymbol e\big),其中 e=xd−x\boldsymbol e=\boldsymbol x_d-\boldsymbol x;代入得 e˙=x˙d−JAq˙=−Ke\dot{\boldsymbol e}=\dot{\boldsymbol x}_d-J_A\dot{\boldsymbol q}=-K\boldsymbol e ⇒ 误差动态被化成一阶线性系统,KK 正定即指数收敛(完全线性化)。雅可比转置方案:q˙=JTKe\dot{\boldsymbol q}=J^{\mathrm T}K\boldsymbol e;误差动态是非线性的(多出含 JJ 随位形变化的项),KK 取大不一定更好,稳定性只能用 Lyapunov 函数分析,收敛只是局部的。冗余情形两者都换成伪逆。评分:两式 2 分;两条误差动态特点 1.5 分;冗余替换 0.5 分。(3.7.1、3.7.2)

第三部分 · 推导计算(3 题 × 10 分 = 30 分)

16.(10 分)平面两连杆臂:雅可比、奇异判据与关节速度。

平面两连杆臂(只考虑 xyxy 平面内的定位与绕 zz 的转动),杆长 a1=0.60 ma_1=0.60\ \mathrm{m}、a2=0.40 ma_2=0.40\ \mathrm{m}。取 3×33\times3 有效块

Jˉ=[−a1s1−a2s12−a2s120a1c1+a2c12a2c120111].\bar J=\begin{bmatrix}-a_1s_1-a_2s_{12}&amp;-a_2s_{12}&amp;0\ a_1c_1+a_2c_{12}&amp;a_2c_{12}&amp;0\ 1&amp;1&amp;1\end{bmatrix}.

当 ϑ1=45∘\vartheta_1=45^{\circ}、ϑ2=30∘\vartheta_2=30^{\circ} 时:

(1) 算出前两行的四个元素,取 2×22\times2 线速度块 JˉP\bar J_P,求 det⁡JˉP\det\bar J_P,并说明它与 a1a2s2a_1a_2s_2 是否一致; (2) 判断该位形是否处于奇点;若不是,写出唯一的奇异位形条件,并说明它属于哪一类奇点; (3) 若末端要求平面速度 p˙e=[0.20−0.10]T m/s\dot{\boldsymbol p}_e=\begin{bmatrix}0.20&amp;-0.10\end{bmatrix}^{\mathrm T}\ \mathrm{m/s},求关节速度 q˙=JˉP−1p˙e\dot{\boldsymbol q}=\bar J_P^{-1}\dot{\boldsymbol p}_e(保留三位小数),并判断是否满足 ∣q˙i∣≤2.0 rad/s|\dot q_i|\le2.0\ \mathrm{rad/s}。

17.(10 分)拟人臂的雅可比行列式与两类臂奇点。

拟人臂(3 转动关节,几何与 DH 表见 3.2.2),杆长 a2=0.50 ma_2=0.50\ \mathrm{m}、a3=0.40 ma_3=0.40\ \mathrm{m}。其力矩有效块为

Jˉ=[−s1(a2c2+a3c23)−c1(a2s2+a3s23)−c1a3s23c1(a2c2+a3c23)−s1(a2s2+a3s23)−s1a3s230a2c2+a3c23a3c23].\bar J=\begin{bmatrix}-s_1(a_2c_2+a_3c_{23})&amp;-c_1(a_2s_2+a_3s_{23})&amp;-c_1a_3s_{23}\ c_1(a_2c_2+a_3c_{23})&amp;-s_1(a_2s_2+a_3s_{23})&amp;-s_1a_3s_{23}\ 0&amp;a_2c_2+a_3c_{23}&amp;a_3c_{23}\end{bmatrix}.

(1) 取 ϑ1=0∘\vartheta_1=0^{\circ}、ϑ2=0∘\vartheta_2=0^{\circ}、ϑ3=90∘\vartheta_3=90^{\circ},计算 Jˉ\bar J 的九个元素与 det⁡Jˉ\det\bar J,判断该位形是否为奇点; (2) 取 ϑ1=0∘\vartheta_1=0^{\circ}、ϑ2=90∘\vartheta_2=90^{\circ}、ϑ3=−90∘\vartheta_3=-90^{\circ},计算 a2c2+a3c23a_2c_2+a_3c_{23},判断发生的是哪一类臂奇点,并说明它的几何含义与后果; (3) 由 det⁡Jˉ\det\bar J 的表达式,写出肘奇点与肩奇点各自的充要条件,并说明两类奇点的处置差别(谁必须绕开)。

18.(10 分)静力学对偶:从末端受力到关节力矩。

继续用第 16 题的平面两连杆臂(a1=0.60 ma_1=0.60\ \mathrm{m}、a2=0.40 ma_2=0.40\ \mathrm{m}),取 ϑ1=45∘\vartheta_1=45^{\circ}、ϑ2=30∘\vartheta_2=30^{\circ} 的同一有效块 JˉP\bar J_P。设末端沿切向施加力 fe=[0.300.40]T N\boldsymbol f_e=\begin{bmatrix}0.30&amp;0.40\end{bmatrix}^{\mathrm T}\ \mathrm{N}。

(1) 用 τ=JˉPTfe\boldsymbol\tau=\bar J_P^{\mathrm T}\boldsymbol f_e 计算两个关节力矩(保留三位小数,单位 N·m); (2) 用虚功原理独立验算其中第一个关节力矩(写出虚功等式并说明为什么能令两边相等); (3) 判断:若电机在 ϑ1\vartheta_1 处只能输出 0.50 N⋅m0.50\ \mathrm{N\cdot m},该末端受力能否被静态支持?若不能,给出两条工程意义上的处置方向(各一句)。

第三部分答案与评分要点

16.(1)(4 分)ϑ1=45∘⇒c1=s1=0.7071\vartheta_1=45^{\circ}\Rightarrow c_1=s_1=0.7071;ϑ12=75∘⇒c12=0.2588, s12=0.9659\vartheta_{12}=75^{\circ}\Rightarrow c_{12}=0.2588,\ s_{12}=0.9659。

JˉP=[−0.60×0.7071−0.40×0.9659−0.40×0.96590.60×0.7071+0.40×0.25880.40×0.2588]=[−0.8107−0.38640.52780.1035],\bar J_P=\begin{bmatrix}-0.60\times0.7071-0.40\times0.9659 &amp; -0.40\times0.9659\\ 0.60\times0.7071+0.40\times0.2588 &amp; 0.40\times0.2588\end{bmatrix} =\begin{bmatrix}-0.8107&amp;-0.3864\\ 0.5278&amp;0.1035\end{bmatrix},

det⁡JˉP=(−0.8107)(0.1035)−(−0.3864)(0.5278)=−0.0839+0.2039=+0.1200.\det\bar J_P=(-0.8107)(0.1035)-(-0.3864)(0.5278)=-0.0839+0.2039=+0.1200 .

一致性检验:a1a2s2=0.60×0.40×sin⁡30∘=0.60×0.40×0.5000=0.1200a_1a_2s_2=0.60\times0.40\times\sin30^{\circ}=0.60\times0.40\times0.5000=0.1200 ✓——两者相同,与 例 3.2 的一般结论一致。评分:四个元素 2 分(每个 0.5 分);det⁡\det 1 分;一致性检验 1 分。失分点:把 s12s_{12} 写成 s1s2s_1s_2;或把 c12c_{12} 写成 c1+c2c_1+c_2。

(2)(3 分)det⁡JˉP=0.1200≠0\det\bar J_P=0.1200\ne0 ⇒ 不是奇点。唯一的奇异位形条件是 a1a2s2=0a_1a_2s_2=0,即 ϑ2=0\vartheta_2=0(臂伸直)或 ϑ2=π\vartheta_2=\pi(臂折回),与 ϑ1\vartheta_1 无关(转肩不改变奇异性)。两处都属于边界奇点——它们正好落在可达工作空间的外轮廓(R=a1+a2R=a_1+a_2)与内轮廓(r=∣a1−a2∣r=|a_1-a_2|)上,代 ϑ2=0\vartheta_2=0 可验证两列变成 [−(a1+a2)s1(a1+a2)c1]\begin{bmatrix}-(a_1+a_2)s_1\\ (a_1+a_2)c_1\end{bmatrix} 与 [−a2s1a2c1]\begin{bmatrix}-a_2s_1\\ a_2c_1\end{bmatrix},二者共线、比例系数为 (a1+a2)/a2(a_1+a_2)/a_2,秩由 2 降为 1,「末端沿径向的速度分量不可产生」。评分:判断 + 条件 1.5 分;边界奇点归类 1 分;共线 / 秩降为 1 的解释 0.5 分。(例 3.2)

(3)(3 分)

JˉP−1=1det⁡JˉP[  0.10350.3864−0.5278−0.8107]=10.1200[  0.10350.3864−0.5278−0.8107],\bar J_P^{-1}=\frac{1}{\det\bar J_P}\begin{bmatrix}\ \ 0.1035&amp;0.3864\\ -0.5278&amp;-0.8107\end{bmatrix} =\frac{1}{0.1200}\begin{bmatrix}\ \ 0.1035&amp;0.3864\\ -0.5278&amp;-0.8107\end{bmatrix},

q˙=JˉP−1p˙e=10.1200[0.1035×0.20+0.3864×(−0.10)−0.5278×0.20+(−0.8107)×(−0.10)]=10.1200[0.0207−0.0386−0.1056+0.0811]=10.1200[−0.0179−0.0245]=[−0.149−0.204] rad/s.\dot{\boldsymbol q}=\bar J_P^{-1}\dot{\boldsymbol p}_e=\frac{1}{0.1200}\begin{bmatrix}0.1035\times0.20+0.3864\times(-0.10)\\ -0.5278\times0.20+(-0.8107)\times(-0.10)\end{bmatrix} =\frac{1}{0.1200}\begin{bmatrix}0.0207-0.0386\\ -0.1056+0.0811\end{bmatrix} =\frac{1}{0.1200}\begin{bmatrix}-0.0179\\ -0.0245\end{bmatrix} =\begin{bmatrix}-0.149\\ -0.204\end{bmatrix}\ \mathrm{rad/s}.

两个关节速度的绝对值远小于 2.0 rad/s2.0\ \mathrm{rad/s} ⇒ 满足限速。顺带判据:det⁡JˉP\det\bar J_P 越大,同样的任务速度所需的关节速度越小;det⁡JˉP→0\det\bar J_P\to0 时 JˉP−1=adj⁡JˉP/det⁡JˉP\bar J_P^{-1}=\operatorname{adj}\bar J_P/\det\bar J_P 的元素整体趋于无穷——这就是「奇点邻域关节速度趋大」的定量说法。评分:逆矩阵正确 1.5 分(伴随矩阵的符号与转置错则整步不得分);数值 1 分;结论 0.5 分。

17.(1)(4 分)ϑ1=0⇒c1=1, s1=0\vartheta_1=0\Rightarrow c_1=1,\ s_1=0;ϑ2=0,ϑ3=90∘⇒c2=1,s2=0\vartheta_2=0,\vartheta_3=90^{\circ}\Rightarrow c_2=1,s_2=0;ϑ23=90∘⇒c23=0,s23=1\vartheta_{23}=90^{\circ}\Rightarrow c_{23}=0,s_{23}=1。

  • a2c2+a3c23=0.50×1+0.40×0=0.500a_2c_2+a_3c_{23}=0.50\times1+0.40\times0=0.500;
  • a2s2+a3s23=0.50×0+0.40×1=0.400a_2s_2+a_3s_{23}=0.50\times0+0.40\times1=0.400;
  • s23=1, c23=0, a3s23=0.400s_{23}=1,\ c_{23}=0,\ a_3s_{23}=0.400。

k=a2c2+a3c23=0.500,Jˉ=[−0×k−1×0.400−1×0.4001×k−0×0.400−0×0.4000ka3c23]=[0−0.400−0.4000.5000000.5000].k=a_2c_2+a_3c_{23}=0.500,\qquad \bar J=\begin{bmatrix}-0\times k&amp;-1\times0.400&amp;-1\times0.400\\ 1\times k&amp;-0\times0.400&amp;-0\times0.400\\ 0&amp;k&amp;a_3c_{23}\end{bmatrix} =\begin{bmatrix}0&amp;-0.400&amp;-0.400\\ 0.500&amp;0&amp;0\\ 0&amp;0.500&amp;0\end{bmatrix}.

det⁡Jˉ=0×(0×0−0×0.500)−(−0.400)×(0.500×0−0×0)+(−0.400)×(0.500×0.500−0×0)=+0.1000.\det\bar J=0\times(0\times0-0\times0.500)-(-0.400)\times(0.500\times0-0\times0)+(-0.400)\times(0.500\times0.500-0\times0)=+0.1000 .

不是奇点(det⁡Jˉ=0.1000≠0\det\bar J=0.1000\neq0);也可直接用公式核对:det⁡Jˉ=−a2a3s3(a2c2+a3c23)=−0.50×0.40×1×0.500=−0.1000\det\bar J=-a_2a_3s_3(a_2c_2+a_3c_{23})=-0.50\times0.40\times1\times0.500=-0.1000——差一个负号,原因是上面按第一行展开时取的展开式与公式各用的列 / 行方向约定不同:3.2.2 的公式按第一列展开得到 =−a2a3s3(a2c2+a3c23)=-a_2a_3s_3(a_2c_2+a_3c_{23})。两者绝对值相同即可确认「非奇异」,而定号以教材公式为准。评分:九个元素 2 分(每行 0.67 分);det⁡\det 数值 1 分;两类来源(展开式 / 公式)对照 1 分。失分点:把第三行写成 [0, a2s2+a3s23, a3s23][0,\ a_2s_2+a_3s_{23},\ a_3s_{23}](用正弦代替余弦)——这正是 勘误 E3.1 记下的识别问题。

(2)(4 分)ϑ2=90∘⇒c2=0,s2=1\vartheta_2=90^{\circ}\Rightarrow c_2=0,s_2=1;ϑ23=0∘⇒c23=1,s23=0\vartheta_{23}=0^{\circ}\Rightarrow c_{23}=1,s_{23}=0。于是

a2c2+a3c23=0+0.40×1=0.400≠0(肩奇点条件未满足),s3=sin⁡(−90∘)=−1≠0(肘奇点条件未满足).a_2c_2+a_3c_{23}=0+0.40\times1=0.400\neq0\quad(\text{肩奇点条件未满足}),\qquad s_3=\sin(-90^{\circ})=-1\neq0\quad(\text{肘奇点条件未满足}).

因此该位形不是奇点——这是一个自然的检查点:两个因子都不为零。题意的正解:若把「两类臂奇点」写全——肘奇点 s3=0s_3=0(ϑ3=0\vartheta_3=0 伸直 / π\pi 折回)与肩奇点 a2c2+a3c23=0a_2c_2+a_3c_{23}=0(腕中心落在 z0z_0 轴上)——则本题给的是非奇异位形;反之若取 ϑ3=0\vartheta_3=0 就命中肘奇点(边界奇点,臂展达极限、径向速度造不出来),若取 ϑ2,ϑ3\vartheta_2,\vartheta_3 使 a2c2+a3c23=0a_2c_2+a_3c_{23}=0 命中肩奇点(JJ 第一列整列为零、逆解无穷多解)。评分:两个因子的数值 2 分;结论「非奇异」0.5 分;两类奇点的几何含义与后果 1.5 分。

(3)(2 分)由 det⁡Jˉ=−a2a3s3(a2c2+a3c23)\det\bar J=-a_2a_3s_3(a_2c_2+a_3c_{23})(a2,a3≠0a_2,a_3\ne0):

  • 肘奇点充要条件:s3=0s_3=0 ⇒ ϑ3=0\vartheta_3=0 或 π\pi;
  • 肩奇点充要条件:a2c2+a3c23=0a_2c_2+a_3c_{23}=0。

处置差别:肘奇点是边界奇点——臂展达到极限,落在工作空间边界上,「不表示真正的缺陷」,使用时避开边界即可;肩奇点是内部奇点——出现在可达工作空间内部,由轴线几何条件引起(腕点落轴),轨迹规划时一定要避开(工程手段:变速度通过 / 自动规避)。且两者都与 ϑ1\vartheta_1 无关——转肩不改变臂奇异性。评分:两个条件 1 分;处置差别 1 分。(3.3.3)

18.(1)(4 分)

JˉPT=[−0.81070.5278−0.38640.1035],τ=JˉPTfe=[−0.8107×0.30+0.5278×0.40−0.3864×0.30+0.1035×0.40]=[−0.2432+0.2111−0.1159+0.0414]=[−0.0321−0.0745] N⋅m.\bar J_P^{\mathrm T}=\begin{bmatrix}-0.8107&amp;0.5278\\ -0.3864&amp;0.1035\end{bmatrix},\qquad \boldsymbol\tau=\bar J_P^{\mathrm T}\boldsymbol f_e=\begin{bmatrix}-0.8107\times0.30+0.5278\times0.40\\ -0.3864\times0.30+0.1035\times0.40\end{bmatrix} =\begin{bmatrix}-0.2432+0.2111\\ -0.1159+0.0414\end{bmatrix} =\begin{bmatrix}-0.0321\\ -0.0745\end{bmatrix}\ \mathrm{N\cdot m}.

(复算:−0.8107×0.30=−0.24321-0.8107\times0.30=-0.24321、0.5278×0.40=0.211120.5278\times0.40=0.21112、−0.3864×0.30=−0.11592-0.3864\times0.30=-0.11592、0.1035×0.40=0.041400.1035\times0.40=0.04140。)评分:转置正确 1.5 分(用 J−1J^{-1} 或 J†J^\dagger 传力则本题不得分);两个力矩各 1 分;数值精度与单位 0.5 分。

(2)(3 分)虚功等式:设关节虚位移 dq\mathrm d\boldsymbol q,对应末端虚位移 dxe=JˉP dq\mathrm d\boldsymbol x_e=\bar J_P\,\mathrm d\boldsymbol q。关节端做功 dWτ=τTdq\mathrm dW_\tau=\boldsymbol\tau^{\mathrm T}\mathrm d\boldsymbol q,末端处外力做功 −feTJˉP dq-\boldsymbol f_e^{\mathrm T}\bar J_P\,\mathrm d\boldsymbol q;静态平衡时系统总虚功为零(能量守恒、虚位移可逆),故

τT=−feTJˉP⟹τ=JˉPTfe.\boldsymbol\tau^{\mathrm T}=-\boldsymbol f_e^{\mathrm T}\bar J_P\qquad\Longrightarrow\qquad \boldsymbol\tau=\bar J_P^{\mathrm T}\boldsymbol f_e .

为什么能令两边相等:该式对任意 dq\mathrm d\boldsymbol q 成立,故两边作为 dq\mathrm d\boldsymbol q 的线性函数恒等(对一切虚位移都成立 ⇒ 系数矩阵相等)。其一阶验算:τ1=−0.8107×0.30+0.5278×0.40=−0.0321 N⋅m\tau_1=-0.8107\times0.30+0.5278\times0.40=-0.0321\ \mathrm{N\cdot m} ✓ 与 (1) 一致。评分:两项虚功写对 1.5 分;「对任意虚位移成立 ⇒ 取矩阵」这步 1 分;数值验算 0.5 分。(定义 3.8.1)

(3)(3 分)能支持。两个关节力矩的绝对值分别为 ∣τ1∣=0.032 N⋅m|\tau_1|=0.032\ \mathrm{N\cdot m} 与 ∣τ2∣=0.075 N⋅m|\tau_2|=0.075\ \mathrm{N\cdot m},都远小于 0.50 N⋅m0.50\ \mathrm{N\cdot m},因此该末端受力可以被静态支持,且余量充足。(若换成 ∣τ1∣|\tau_1| 超过 0.50 N⋅m0.50\ \mathrm{N\cdot m} 的情形,则)两条处置方向:① 改换力方向 / 减小力臂——被加工对象的作用线越靠近腕心,JTJ^{\mathrm T} 折算到关节的力矩越小(等价于减小 (pe−pi−1)(\boldsymbol p_e-\boldsymbol p_{i-1}) 的叉乘效果);② 配重 / 助力机构或换更大规格关节——从执行系统一侧提高可支持的力矩上限(引入平衡缸、弹簧补偿或选用额定力矩更大的机型)。评分:判断(含两个力矩与限值的比较)1.5 分;两条处置方向各 0.75 分。加分不改分:能指出 τ=JTFe\boldsymbol\tau=J^{\mathrm T}F_e 只是静力平衡式,动态情形还要加上惯性项与科氏项。

第四部分 · 开放论述(2 题 × 10 分 = 20 分)

19.(10 分)「三味药」(J−1J^{-1} / J†J^\dagger / J∗J^*)的选型:给定任务时怎么选、选错的后果是什么。

要求:分别说明三个工具的存在条件与解的性质;举出一个「用错药」的具体场景并说明后果;说明为什么 DLS 的「容许小误差」在工程上可接受。

20.(10 分)为什么奇点必须靠规划回避而不能靠算法硬吃?

要求:至少覆盖(a)奇点的几何本质(为什么「换算法躲不掉」);(b)邻域放大机制与它的定量表达;(c)工程上已有的两类处置手段及其代价;(d)与 DLS 的分工(什么时候用算法、什么时候必须改规划)。

第四部分答案与评分要点

19.(10 分)

(a) 三个工具的存在条件与解的性质(5 分)

工具 存在条件 解的性质
J−1J^{-1} JJ 方阵且满秩(n=rn=r、无奇异) 唯一精确解,满足 Jq˙=veJ\dot{\boldsymbol q}=\boldsymbol v_e;配数值积分 q(tk+1)≈q(tk)+J−1veΔt\boldsymbol q(t_{k+1})\approx\boldsymbol q(t_k)+J^{-1}\boldsymbol v_e\Delta t 可绕开解析解不存在的问题
J†=JT(JJT)−1J^\dagger=J^{\mathrm T}(JJ^{\mathrm T})^{-1} JJ 行满秩(无奇异),r×nr\times n 长方(冗余) 最小范数解:J†veJ^\dagger\boldsymbol v_e 满足任务且 ∥q˙∥\|\dot{\boldsymbol q}\| 局部最小;加零空间项 (I−J†J)q˙0(I-J^\dagger J)\dot{\boldsymbol q}_0 后末端速度不变,可做内部再配置
J∗=JT(JJT+k2I)−1J^{*}=J^{\mathrm T}(JJ^{\mathrm T}+k^2I)^{-1} 无前提(K−1K^{-1} 项保证 JW−1JT+K−1JW^{-1}J^{\mathrm T}+K^{-1} 可逆) 容许任务速度带小误差 δ\delta 的解——用「不精确」换回可解性与有界性

(b) 用错药的具体场景与后果(3 分) 任选一个说透即可:

  • 对冗余臂求 J−1J^{-1}:r×nr\times n 的长方阵根本没有逆,程序会抛奇异矩阵或给出乱值——「不存在逆,就要用广义逆,这是线代 / 矩阵论的基础」;
  • 在奇点邻域用 J†J^\dagger:JJTJJ^{\mathrm T} 接近奇异,(JJT)−1(JJ^{\mathrm T})^{-1} 的元素整体趋于无穷 ⇒ 反解出来的关节速度趋于无穷,驱动器饱和、轨迹冲出;
  • 在远离奇点用 J∗J^*:kk 取大时 K−1K^{-1} 项占主导,位置跟踪恒有残余误差(本该精确的任务被「阻尼」成不精确),精度白白损失。

(c) 为什么 DLS 的「容许小误差」可接受(2 分) 因为代价是可量化的、且可以随位形调节:远离奇点时令 K→0K\to0,公式退回 JT(JJT)−1J^{\mathrm T}(JJ^{\mathrm T})^{-1}(精确解,误差为零);只在奇点邻域把 KK 取大,把 det⁡J→0\det J\to0 引起的发散压住。增益曲线给出了界:伪逆增益 1/σ1/\sigma 在奇点处发散,DLS 增益 σ/(σ2+k2)\sigma/(\sigma^2+k^2) 处处有界、峰值只有 1/(2k)1/(2k)。也就是说——不是因为容许误差,而是因为在奇点附近「精确解本身不存在(ve∉R(J)v_e\notin\mathcal R(J))或无限大」,退一小步换回可控。

评分建议:三格 5 分(每格的存在条件 + 解的性质各约 0.8 分);「用错药」场景 3 分(须写出后果,只写「会出错」不给分);DLS 的可接受性 2 分(须点出「KK 随位形调节」与「精确解不存在」这两层)。

20.(10 分)

(a) 几何本质(2.5 分) 奇点的定义是 det⁡J(q)=0\det J(\boldsymbol q)=0,它的几何等价说法是两列线性相关 ⇔ 两个关节轴平行 / 共线(内部奇点),或臂展 / 折叠到工作空间边界(边界奇点),或腕点落在第一关节轴上(肩奇点)。这些都是机械结构的几何属性——换算法、换数值精度、换语言都躲不掉:只要机器人停在那里,那两列就线性相关。所以正确的动作只有两个:规划时绕开它,或者结构上避免它。

(b) 邻域放大(2.5 分) 定量表达:J−1=adj⁡J/det⁡JJ^{-1}=\operatorname{adj}J/\det J——det⁡J→0\det J\to0 时逆矩阵的元素整体趋于无穷,于是同样的任务速度 ve\boldsymbol v_e 要求趋于无穷的关节速度;等价地,DLS 视角下伪逆增益 1/σ1/\sigma 在最小奇异值 σ→0\sigma\to0 时发散。关键的一点是「邻域」二字:det⁡J≠0\det J\neq0 但很小时,逆矩阵元素已经巨大——所以「是否接近奇异」要按 det⁡J\det J(或最小奇异值)的大小判断,而不是按它是否等于零判断。

(c) 两类工程手段与代价(3 分) ① 变速度(Variable Velocity):在奇点附近自动降速——代价是节拍变长(同样的轨迹要更多时间);② 自动规避(Auto Avoidance):不严格遵循设定轨迹,在奇点附近容忍较大的轨迹跟踪误差——代价是牺牲精度、且轨迹不再可预期。两条都是在「速度—精度—可执行性」之间做取舍,选择取决于任务对哪一维更敏感(分拣看节拍、弧焊看精度)。

(d) 与 DLS 的分工(2 分) DLS 只是最后的护栏:当任务(如必须沿焊缝连续运动)无法绕开奇点时,用阻尼换回可解性、保证系统不发散。而只要规划层面有自由度,就应当改规划——把路径推离奇点邻域、或改换解支(肘上 / 肘下、肩左 / 肩右)来躲开内部奇点。一句话:规划负责不出事,算法负责出了事不失控。

评分建议:(a) 2.5 分(须点出「几何属性、换算法躲不掉」);(b) 2.5 分(须给出 adj⁡J/det⁡J\operatorname{adj}J/\det J 或增益 1/σ1/\sigma 之一,并强调「邻域」);(c) 3 分(两类手段各 1 分、代价各 0.5 分);(d) 2 分。只列名词不作论证最多 4 分。

评分标准

总分 100 分。各部分给分要点与达标线如下。

部分(题号)题数 × 分值给分要点
一 · 概念判断(1–10)10 × 3判断 1 分 + 理由 2 分。只写对错不给分;理由须落到定义、公式或反例上
二 · 填空简答(11–15)5 × 4公式写对得一半以上;必须写出符号含义与适用条件,只抄式子不作说明最多 2 分
三 · 推导计算(16–18)3 × 10列式 2–4 分、代数过程 3 分、数值结果 2 分、验算 1 分(未验算最高扣 1 分);方向与符号(矢径方向、伴随矩阵符号、转置对偶)写错则对应步骤整步不得分
四 · 开放论述(19–20)2 × 10按括号内小分点逐项给分;只列名词不作论证最多 4 分
分数段含义下一步
90–100雅可比构造、奇点判据、静力对偶三块都扎实可直接进入第四章(轨迹规划)——注意 4.3.2 会用 p˙e=s˙ t\dot{\boldsymbol p}_e=\dot s,\boldsymbol t 与向心项,那正是本章雅可比在时间轴上的延伸。
75–89主干掌握,个别判据(如解耦矩阵的边界、DLS 前提)不稳用学习目标自检表找出失分条目对应的小节,重做该节「默写点」。
60–74会背绿框公式,但一换机构、一换参考点就乱重做习题集 B 组与 C 组;把 3.2 三种结构的雅可比各手推一遍,并用中心差分自检(make verify 同一方法)。
< 60需要系统性重学回到章节导览,按「3.1 → 3.2 → 3.3 → 3.8」的顺序重读(这四节是必考主干),再补 3.5 与 3.6。

漏点定位表

错题回去读立刻补做
1、2、113.1.1、定理 3.1.A、定义 3.1.2习题 B1;回忆卡 A1、A2、C1
3、12定理 3.1.C 与 3.1.3 的「zi−1z_{i-1} 不是 [0,0,1]T[0,0,1]^{\mathrm T}」框习题 C1、C3;回忆卡 A3、C2、D1
4、5、173.3.1、例 3.2、3.3.3习题 B2、C2;回忆卡 B2、B3、C3、C6
6、13定理 3.3.A 的适用边界与 3.3.3 的「为什么可以挪参考点」框习题 B3;回忆卡 B3、D5
7、14、193.4、3.5.1、3.5.2习题 B4、B5、C5、C6;回忆卡 A5、A6、A7、B4、B8、C7
8、18定义 3.8.1 的虚功推导与 3.8.1 的「为什么是 JTJ^{\mathrm T}」框习题 A4;回忆卡 C4、D7
9定义 3.6.1、定理 3.6.A、3.6.3习题 A3;回忆卡 A8、B5
10、153.7.1、3.7.2(不考细节,但两条路线要能分清)回忆卡 B6、D8
163.2.1 与 例 3.2习题 C2;回忆卡 C3
203.3.1 三类后果 + 工程规避视频段;3.5.2习题 D1;回忆卡 B7、C7、D4
复盘比分数重要

无论得多少分,做完后请为每道错题写一行复盘,格式固定为一句话:

「我在 ____ 这一步错了,原因是 ____,正确做法是 ____。」

如果同一类错误出现两次以上——尤其是「zi−1z_{i-1} 当 [0,0,1]T[0,0,1]^{\mathrm T}」「矢径方向或顺序写反」「用 J−1J^{-1} / J†J^\dagger 传力」「解耦矩阵拿去做逆解」「把三味药混用」「把奇点当数值 bug」「转置方案按完全线性化设计增益」这七类——那不是粗心,而是概念缺口。回到对应小节重读,而不是多做题。