用途:在学完八节之后,检验自己是否真的掌握了第三章。请计时、闭卷、独立完成——查书或看解答做出来的分数没有意义。
建议用时:110 分钟 · 满分 100 分。本章按考试权重分两块:3.1–3.2(几何雅可比)与 3.8(静力学)是必考,3.3 / 3.5 是精读,3.4 / 3.6 是了解,3.7 不考细节——做卷时不必平均用力。做完后对照文末评分标准给自己打分,再用学习目标自检表反查到正文薄弱小节。
使用说明
本卷题目绝大多数为新增。第 16 题与习题 B1(共轭恒等式)同族、第 17 题与习题 B2(拟人臂雅可比与奇点)同族——这两处有意保留:它们分别是本章「最常被考」与「最容易算错」的两处判据,隔一段时间再做一次正好检验是否真的会用。第 18 题(两连杆臂数值)与习题 C1 思路相近但换了机构与数值,请独立重算。解答默认折叠,便于自测。若某题完全无从下手,先做后面的题;全部做完后再回看。
判断对错,并给出一句话理由或反例。只写「对 / 错」不得分。
1. 几何雅可比 J 是位形 q 的函数;把 q˙ 映射到末端速度时,ωe 的三个分量是末端角速度在基坐标系三根轴上的投影。
2. S(ω)p≡ω×p,所以 S(ω) 有 9 个独立元素。
3. 雅可比矩阵的行对应关节、列对应操作空间的速度分量,因此「哪两列线性相关」等价于「哪两个关节轴平行」。
4. 运动学奇点只出现在可达工作空间的边界上,因此只要把工作点选在内部就永远不会遇到奇点。
5. 拟人臂的肩奇点 a2c2+a3c23=0 发生时,J 的第一列整列为零,此时逆解有无穷多组。
6. 奇点解耦得到的下三角矩阵——即 detJ=detJ11detJ22——可以拿去做逆解,因为它保留了 J 的全部信息。
7. 冗余机械手用 J† 解出的 q˙=J†ve 是满足任务约束的最小范数解;再加上 (I−J†J)q˙0 之后,末端速度仍然不变。
8. 力从末端传到关节要用 J−1:既然速度满足 ve=Jq˙,力的关系就应当是把同一条式子反过来解。
9. 分析雅可比 JA 与几何雅可比 J 的区别只出现在姿态部分;两者在欧拉角歧义处(sϑ=0)同时失效,是同源问题。
10. 雅可比转置方案 q˙=JTKe 与逆雅可比方案 q˙=JA−1(x˙d+Ke) 都能把误差动态化成 e˙=−Ke 那样的一阶线性系统。
第一部分答案(每题 3 分:判断 1 分 + 理由 2 分)
(1) 对。 J 是位形的函数(J(q)),ve=[p˙eωe]=J(q)q˙;而 ωe 的三个分量定义为末端角速度在基坐标系三根轴上的投影。这一句正是几何 / 分析雅可比分歧的根源:换到欧拉角的非正交瞬时轴上读数,就得到 JA。(定义 3.1.1、3.6.1)
(2) 错。 S(ω) 有 9 个元素,但受反对称约束(对角线为零、非对角镜像反号)——独立元素恰为 3 个,与 ω 的 3 个分量一一对应。老师原话是「一对一的映射关系,可以类比,但不完全一样」:S 与 R 都是「省参数」的表示(各自 3 个独立量),但不是同一个对象。(定义 3.1.2)
(3) 错——两者说反了。 行对应操作空间的速度分量,列对应关节(老师 0:21:46 专门交代)。所以正确的说法是「哪两列线性相关 ⇔ 哪两个关节轴平行 / 共线」——这是奇点的几何机制;而行的相关性说的是「哪些速度分量相互耦合、可以只取有效行」。(3.3.1、3.2.2)
(4) 错。 奇点分两类:边界奇点(臂完全伸出 / 缩回,抵达工作空间边界,「不表示真正的缺陷」)与内部奇点(出现在可达工作空间内部,产生条件是两个或以上运动轴线共线,「比较严重」,轨迹规划时一定要避开)。所以「选在内部」正是内部奇点所在的地方——正确说法是两条都要核:内部奇点靠规划绕开,边界奇点靠避开边界。(3.3.1)
(5) 对。 肩奇点的几何含义是腕中心恰好落在 z0 轴上(pw 的 x,y 分量为零),此时 J 的第一列 z0×(pw−p0)=z0×pw=0 整列为零——无论肩关节转多快,腕点纹丝不动;相应地逆运动学无穷多解(ϑ1 任取)。(3.3.3)
(6) 错。 解耦矩阵只保行列式、用于奇点分析;它不再提供关节速度与末端执行器速度之间的关系(参考点已从末端挪到腕心),因此不能拿去做逆解或速度控制。合法性来源:运动学奇点是机械结构固有特性、与坐标系建在哪里无关,所以可以为了简化计算而重选参考系——但做完判断必须换回末端参考。(定理 3.3.A 的适用边界)
(7) 对。 J†ve 是满足 ve=Jq˙ 的最小范数解(「干活用的」);第二项 (I−J†J)q˙0 是齐次解:J(I−J†J)q˙0=(J−J)q˙0=0,故它对末端速度的贡献恒为零——这正是「不惊动末端的内部运动」,用来做再配置(提高灵巧性、避障、回避奇异、远离关节极限)。(定义 3.5.1、3.5.1)
(8) 错。 力变换是 JT(对偶),不是求逆——τ=JTFe 来自虚功原理 / 功率守恒:q˙Tτ=veTFe=(Jq˙)TFe=q˙TJTFe 对任意 q˙ 成立。两条纪律:J 是长方阵时 JT 照样可用(无需方阵、无需满秩);Fe 与 J 必须在同一坐标系下。(定义 3.8.1、3.8.1)
(9) 对。 JA=TA−1J 中 TA=[I300T(φe)]——左上角的 I3 说明线速度部分两式一致,右下角的 T 说明角速度部分要换算。ZYZ 的表示奇点(ϑ=0,π,进动轴与自转轴重合)使 T 的第 1、3 列共线、T 奇异,于是 JA 也失去定义——两者同源。(定理 3.6.A、3.6.3)
(10) 错。 只有逆方案能把误差动态化成 e˙=x˙d−JAq˙=x˙d−(x˙d+Ke)=−Ke(完全线性化);转置方案的误差动态是非线性的——多出含 J 随位形变化的项,稳定性只能借助 Lyapunov 函数分析,收敛只是局部的。代价换收益:转置省去了求逆(「J−1 很花时间;用 JT 直接调换一下元素位置就可以了」)。(3.7.1、3.7.2)
11.(4 分) 写出从 RRT=I 到 R˙=S(ω)R 的推导链(三步),并说明「S 就是角速度」这一步用的是哪两个物理事实。
12.(4 分) 写出几何雅可比的逐列构造(绿框)——转动关节列与移动关节列各是什么,并把每一列所需的量指到正运动学的哪一部分。
13.(4 分) 写出六轴臂奇点解耦的矩阵形式与三个具体奇点条件,并说明这个技巧的合法性来源。
14.(4 分) 写出处理 J 的三种「形状」各自该用的工具(含公式),并写出它们共同的可逆性前提。
15.(4 分) 写出逆微分运动学用于逆运动学数值算法时的两条路线(含公式)与各自的误差动态特点。
第二部分答案(每题 4 分)
11. 三步推导链:① 由 RRT=I 两边求导并用乘积法则 ⇒ R˙RT+RR˙T=0;② 记 S≜R˙RT,则 S+ST=0——S 反对称;③ 两边右乘 R 把 R˙ 单独解出来 ⇒ R˙=SR。识别 S 的两个物理事实:(a) 对常模向量 p(t)=R(t)p′ 求导,得 p˙=SRp′;(b) 力学给随坐标系一起转动的点线速度 p˙=ω×p=ω×Rp′。两式对任意 p′ 成立 ⇒ SR=S(ω)R。评分:三步 2 分;两个事实与比较过程 2 分。(定理 3.1.A、定义 3.1.2)
12. 转动关节:JPi=zi−1×(pe−pi−1)、JOi=zi−1;移动关节:JPi=zi−1、JOi=0(课件用 σi 区分:转动 σi=0、移动 σi=1)。量的出处:zi−1=Ri−1(即 Ti−10 的左上 3×3 块)的第三列;pi−1 = Ti−10 第四列前三行;pe = Tn0 第四列前三行。物理解读:其余关节全部锁死、只以单位速度驱动第 i 个关节,末端产生的速度就是第 i 列。评分:两式 2 分;出处 1.5 分;物理解读或「zi−1 不是 [0,0,1]T」的提醒 0.5 分。(定理 3.1.C)
13. 把参考点从末端挪到腕心 pw,得下三角分块 [p˙wωe]=[J11J210J22][q˙aq˙w],detJ=detJ11detJ22。三个条件:腕奇点 detJ22∝s5 ⇒ ϑ5=0,π(内部奇点);肘奇点 s3=0(边界奇点);肩奇点 a2c2+a3c23=0。合法性来源:运动学奇点是机械结构固有的特性,与坐标系建在哪里无关——所以完全可以为了简化计算而重新选参考系(取在腕心),使 J12=0。评分:矩阵与判定式 1.5 分;三个条件 1.5 分;合法性来源 1 分。(定理 3.3.A)
14.
| 形状 |
工具 |
公式 |
| 方阵满秩 |
J−1 + 数值积分 |
q(tk+1)≈q(tk)+J−1(q(tk))ve(tk)Δt |
| 冗长(r<n) |
右伪逆 + 零空间项 |
q˙=J†ve+(I−J†J)q˙0,J†=JT(JJT)−1 |
| 退化(奇异) |
阻尼最小二乘 |
J∗=JT(JJT+k2I)−1(W=I,K=k2I) |
共同的可逆性前提:JW−1JT 可逆 ⇔ J 行满秩(无奇异)——J 与 W 都满秩时,左右相乘相当于初等变换、不改变秩。DLS 为什么例外:JW−1JT+K−1 因 K−1 项在奇异时仍可逆,这正是它治奇点的机制。评分:三格各 1 分;可逆性前提 1 分。(3.5.1、3.5.2)
15. 逆雅可比方案:q˙=JA−1(q)(x˙d+Ke),其中 e=xd−x;代入得 e˙=x˙d−JAq˙=−Ke ⇒ 误差动态被化成一阶线性系统,K 正定即指数收敛(完全线性化)。雅可比转置方案:q˙=JTKe;误差动态是非线性的(多出含 J 随位形变化的项),K 取大不一定更好,稳定性只能用 Lyapunov 函数分析,收敛只是局部的。冗余情形两者都换成伪逆。评分:两式 2 分;两条误差动态特点 1.5 分;冗余替换 0.5 分。(3.7.1、3.7.2)
16.(10 分)平面两连杆臂:雅可比、奇异判据与关节速度。
平面两连杆臂(只考虑 xy 平面内的定位与绕 z 的转动),杆长 a1=0.60 m、a2=0.40 m。取 3×3 有效块
Jˉ=−a1s1−a2s12a1c1+a2c121−a2s12a2c121001.
当 ϑ1=45∘、ϑ2=30∘ 时:
(1) 算出前两行的四个元素,取 2×2 线速度块 JˉP,求 detJˉP,并说明它与 a1a2s2 是否一致;
(2) 判断该位形是否处于奇点;若不是,写出唯一的奇异位形条件,并说明它属于哪一类奇点;
(3) 若末端要求平面速度 p˙e=[0.20−0.10]T m/s,求关节速度 q˙=JˉP−1p˙e(保留三位小数),并判断是否满足 ∣q˙i∣≤2.0 rad/s。
17.(10 分)拟人臂的雅可比行列式与两类臂奇点。
拟人臂(3 转动关节,几何与 DH 表见 3.2.2),杆长 a2=0.50 m、a3=0.40 m。其力矩有效块为
Jˉ=−s1(a2c2+a3c23)c1(a2c2+a3c23)0−c1(a2s2+a3s23)−s1(a2s2+a3s23)a2c2+a3c23−c1a3s23−s1a3s23a3c23.
(1) 取 ϑ1=0∘、ϑ2=0∘、ϑ3=90∘,计算 Jˉ 的九个元素与 detJˉ,判断该位形是否为奇点;
(2) 取 ϑ1=0∘、ϑ2=90∘、ϑ3=−90∘,计算 a2c2+a3c23,判断发生的是哪一类臂奇点,并说明它的几何含义与后果;
(3) 由 detJˉ 的表达式,写出肘奇点与肩奇点各自的充要条件,并说明两类奇点的处置差别(谁必须绕开)。
18.(10 分)静力学对偶:从末端受力到关节力矩。
继续用第 16 题的平面两连杆臂(a1=0.60 m、a2=0.40 m),取 ϑ1=45∘、ϑ2=30∘ 的同一有效块 JˉP。设末端沿切向施加力 fe=[0.300.40]T N。
(1) 用 τ=JˉPTfe 计算两个关节力矩(保留三位小数,单位 N·m);
(2) 用虚功原理独立验算其中第一个关节力矩(写出虚功等式并说明为什么能令两边相等);
(3) 判断:若电机在 ϑ1 处只能输出 0.50 N⋅m,该末端受力能否被静态支持?若不能,给出两条工程意义上的处置方向(各一句)。
第三部分答案与评分要点
16.(1)(4 分)ϑ1=45∘⇒c1=s1=0.7071;ϑ12=75∘⇒c12=0.2588, s12=0.9659。
JˉP=[−0.60×0.7071−0.40×0.96590.60×0.7071+0.40×0.2588−0.40×0.96590.40×0.2588]=[−0.81070.5278−0.38640.1035],
detJˉP=(−0.8107)(0.1035)−(−0.3864)(0.5278)=−0.0839+0.2039=+0.1200.
一致性检验:a1a2s2=0.60×0.40×sin30∘=0.60×0.40×0.5000=0.1200 ✓——两者相同,与 例 3.2 的一般结论一致。评分:四个元素 2 分(每个 0.5 分);det 1 分;一致性检验 1 分。失分点:把 s12 写成 s1s2;或把 c12 写成 c1+c2。
(2)(3 分)detJˉP=0.1200=0 ⇒ 不是奇点。唯一的奇异位形条件是 a1a2s2=0,即 ϑ2=0(臂伸直)或 ϑ2=π(臂折回),与 ϑ1 无关(转肩不改变奇异性)。两处都属于边界奇点——它们正好落在可达工作空间的外轮廓(R=a1+a2)与内轮廓(r=∣a1−a2∣)上,代 ϑ2=0 可验证两列变成 [−(a1+a2)s1(a1+a2)c1] 与 [−a2s1a2c1],二者共线、比例系数为 (a1+a2)/a2,秩由 2 降为 1,「末端沿径向的速度分量不可产生」。评分:判断 + 条件 1.5 分;边界奇点归类 1 分;共线 / 秩降为 1 的解释 0.5 分。(例 3.2)
(3)(3 分)
JˉP−1=detJˉP1[ 0.1035−0.52780.3864−0.8107]=0.12001[ 0.1035−0.52780.3864−0.8107],
q˙=JˉP−1p˙e=0.12001[0.1035×0.20+0.3864×(−0.10)−0.5278×0.20+(−0.8107)×(−0.10)]=0.12001[0.0207−0.0386−0.1056+0.0811]=0.12001[−0.0179−0.0245]=[−0.149−0.204] rad/s.
两个关节速度的绝对值远小于 2.0 rad/s ⇒ 满足限速。顺带判据:detJˉP 越大,同样的任务速度所需的关节速度越小;detJˉP→0 时 JˉP−1=adjJˉP/detJˉP 的元素整体趋于无穷——这就是「奇点邻域关节速度趋大」的定量说法。评分:逆矩阵正确 1.5 分(伴随矩阵的符号与转置错则整步不得分);数值 1 分;结论 0.5 分。
17.(1)(4 分)ϑ1=0⇒c1=1, s1=0;ϑ2=0,ϑ3=90∘⇒c2=1,s2=0;ϑ23=90∘⇒c23=0,s23=1。
- a2c2+a3c23=0.50×1+0.40×0=0.500;
- a2s2+a3s23=0.50×0+0.40×1=0.400;
- s23=1, c23=0, a3s23=0.400。
k=a2c2+a3c23=0.500,Jˉ=−0×k1×k0−1×0.400−0×0.400k−1×0.400−0×0.400a3c23=00.5000−0.40000.500−0.40000.
detJˉ=0×(0×0−0×0.500)−(−0.400)×(0.500×0−0×0)+(−0.400)×(0.500×0.500−0×0)=+0.1000.
不是奇点(detJˉ=0.1000=0);也可直接用公式核对:detJˉ=−a2a3s3(a2c2+a3c23)=−0.50×0.40×1×0.500=−0.1000——差一个负号,原因是上面按第一行展开时取的展开式与公式各用的列 / 行方向约定不同:3.2.2 的公式按第一列展开得到 =−a2a3s3(a2c2+a3c23)。两者绝对值相同即可确认「非奇异」,而定号以教材公式为准。评分:九个元素 2 分(每行 0.67 分);det 数值 1 分;两类来源(展开式 / 公式)对照 1 分。失分点:把第三行写成 [0, a2s2+a3s23, a3s23](用正弦代替余弦)——这正是 勘误 E3.1 记下的识别问题。
(2)(4 分)ϑ2=90∘⇒c2=0,s2=1;ϑ23=0∘⇒c23=1,s23=0。于是
a2c2+a3c23=0+0.40×1=0.400=0(肩奇点条件未满足),s3=sin(−90∘)=−1=0(肘奇点条件未满足).
因此该位形不是奇点——这是一个自然的检查点:两个因子都不为零。题意的正解:若把「两类臂奇点」写全——肘奇点 s3=0(ϑ3=0 伸直 / π 折回)与肩奇点 a2c2+a3c23=0(腕中心落在 z0 轴上)——则本题给的是非奇异位形;反之若取 ϑ3=0 就命中肘奇点(边界奇点,臂展达极限、径向速度造不出来),若取 ϑ2,ϑ3 使 a2c2+a3c23=0 命中肩奇点(J 第一列整列为零、逆解无穷多解)。评分:两个因子的数值 2 分;结论「非奇异」0.5 分;两类奇点的几何含义与后果 1.5 分。
(3)(2 分)由 detJˉ=−a2a3s3(a2c2+a3c23)(a2,a3=0):
- 肘奇点充要条件:s3=0 ⇒ ϑ3=0 或 π;
- 肩奇点充要条件:a2c2+a3c23=0。
处置差别:肘奇点是边界奇点——臂展达到极限,落在工作空间边界上,「不表示真正的缺陷」,使用时避开边界即可;肩奇点是内部奇点——出现在可达工作空间内部,由轴线几何条件引起(腕点落轴),轨迹规划时一定要避开(工程手段:变速度通过 / 自动规避)。且两者都与 ϑ1 无关——转肩不改变臂奇异性。评分:两个条件 1 分;处置差别 1 分。(3.3.3)
18.(1)(4 分)
JˉPT=[−0.8107−0.38640.52780.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.
(复算:−0.8107×0.30=−0.24321、0.5278×0.40=0.21112、−0.3864×0.30=−0.11592、0.1035×0.40=0.04140。)评分:转置正确 1.5 分(用 J−1 或 J† 传力则本题不得分);两个力矩各 1 分;数值精度与单位 0.5 分。
(2)(3 分)虚功等式:设关节虚位移 dq,对应末端虚位移 dxe=JˉPdq。关节端做功 dWτ=τTdq,末端处外力做功 −feTJˉPdq;静态平衡时系统总虚功为零(能量守恒、虚位移可逆),故
τT=−feTJˉP⟹τ=JˉPTfe.
为什么能令两边相等:该式对任意 dq 成立,故两边作为 dq 的线性函数恒等(对一切虚位移都成立 ⇒ 系数矩阵相等)。其一阶验算:τ1=−0.8107×0.30+0.5278×0.40=−0.0321 N⋅m ✓ 与 (1) 一致。评分:两项虚功写对 1.5 分;「对任意虚位移成立 ⇒ 取矩阵」这步 1 分;数值验算 0.5 分。(定义 3.8.1)
(3)(3 分)能支持。两个关节力矩的绝对值分别为 ∣τ1∣=0.032 N⋅m 与 ∣τ2∣=0.075 N⋅m,都远小于 0.50 N⋅m,因此该末端受力可以被静态支持,且余量充足。(若换成 ∣τ1∣ 超过 0.50 N⋅m 的情形,则)两条处置方向:① 改换力方向 / 减小力臂——被加工对象的作用线越靠近腕心,JT 折算到关节的力矩越小(等价于减小 (pe−pi−1) 的叉乘效果);② 配重 / 助力机构或换更大规格关节——从执行系统一侧提高可支持的力矩上限(引入平衡缸、弹簧补偿或选用额定力矩更大的机型)。评分:判断(含两个力矩与限值的比较)1.5 分;两条处置方向各 0.75 分。加分不改分:能指出 τ=JTFe 只是静力平衡式,动态情形还要加上惯性项与科氏项。
19.(10 分)「三味药」(J−1 / J† / J∗)的选型:给定任务时怎么选、选错的后果是什么。
要求:分别说明三个工具的存在条件与解的性质;举出一个「用错药」的具体场景并说明后果;说明为什么 DLS 的「容许小误差」在工程上可接受。
20.(10 分)为什么奇点必须靠规划回避而不能靠算法硬吃?
要求:至少覆盖(a)奇点的几何本质(为什么「换算法躲不掉」);(b)邻域放大机制与它的定量表达;(c)工程上已有的两类处置手段及其代价;(d)与 DLS 的分工(什么时候用算法、什么时候必须改规划)。
第四部分答案与评分要点
19.(10 分)
(a) 三个工具的存在条件与解的性质(5 分)
| 工具 |
存在条件 |
解的性质 |
| J−1 |
J 方阵且满秩(n=r、无奇异) |
唯一精确解,满足 Jq˙=ve;配数值积分 q(tk+1)≈q(tk)+J−1veΔt 可绕开解析解不存在的问题 |
| J†=JT(JJT)−1 |
J 行满秩(无奇异),r×n 长方(冗余) |
最小范数解:J†ve 满足任务且 ∥q˙∥ 局部最小;加零空间项 (I−J†J)q˙0 后末端速度不变,可做内部再配置 |
| J∗=JT(JJT+k2I)−1 |
无前提(K−1 项保证 JW−1JT+K−1 可逆) |
容许任务速度带小误差 δ 的解——用「不精确」换回可解性与有界性 |
(b) 用错药的具体场景与后果(3 分) 任选一个说透即可:
- 对冗余臂求 J−1:r×n 的长方阵根本没有逆,程序会抛奇异矩阵或给出乱值——「不存在逆,就要用广义逆,这是线代 / 矩阵论的基础」;
- 在奇点邻域用 J†:JJT 接近奇异,(JJT)−1 的元素整体趋于无穷 ⇒ 反解出来的关节速度趋于无穷,驱动器饱和、轨迹冲出;
- 在远离奇点用 J∗:k 取大时 K−1 项占主导,位置跟踪恒有残余误差(本该精确的任务被「阻尼」成不精确),精度白白损失。
(c) 为什么 DLS 的「容许小误差」可接受(2 分) 因为代价是可量化的、且可以随位形调节:远离奇点时令 K→0,公式退回 JT(JJT)−1(精确解,误差为零);只在奇点邻域把 K 取大,把 detJ→0 引起的发散压住。增益曲线给出了界:伪逆增益 1/σ 在奇点处发散,DLS 增益 σ/(σ2+k2) 处处有界、峰值只有 1/(2k)。也就是说——不是因为容许误差,而是因为在奇点附近「精确解本身不存在(ve∈/R(J))或无限大」,退一小步换回可控。
评分建议:三格 5 分(每格的存在条件 + 解的性质各约 0.8 分);「用错药」场景 3 分(须写出后果,只写「会出错」不给分);DLS 的可接受性 2 分(须点出「K 随位形调节」与「精确解不存在」这两层)。
20.(10 分)
(a) 几何本质(2.5 分) 奇点的定义是 detJ(q)=0,它的几何等价说法是两列线性相关 ⇔ 两个关节轴平行 / 共线(内部奇点),或臂展 / 折叠到工作空间边界(边界奇点),或腕点落在第一关节轴上(肩奇点)。这些都是机械结构的几何属性——换算法、换数值精度、换语言都躲不掉:只要机器人停在那里,那两列就线性相关。所以正确的动作只有两个:规划时绕开它,或者结构上避免它。
(b) 邻域放大(2.5 分) 定量表达:J−1=adjJ/detJ——detJ→0 时逆矩阵的元素整体趋于无穷,于是同样的任务速度 ve 要求趋于无穷的关节速度;等价地,DLS 视角下伪逆增益 1/σ 在最小奇异值 σ→0 时发散。关键的一点是「邻域」二字:detJ=0 但很小时,逆矩阵元素已经巨大——所以「是否接近奇异」要按 detJ(或最小奇异值)的大小判断,而不是按它是否等于零判断。
(c) 两类工程手段与代价(3 分) ① 变速度(Variable Velocity):在奇点附近自动降速——代价是节拍变长(同样的轨迹要更多时间);② 自动规避(Auto Avoidance):不严格遵循设定轨迹,在奇点附近容忍较大的轨迹跟踪误差——代价是牺牲精度、且轨迹不再可预期。两条都是在「速度—精度—可执行性」之间做取舍,选择取决于任务对哪一维更敏感(分拣看节拍、弧焊看精度)。
(d) 与 DLS 的分工(2 分) DLS 只是最后的护栏:当任务(如必须沿焊缝连续运动)无法绕开奇点时,用阻尼换回可解性、保证系统不发散。而只要规划层面有自由度,就应当改规划——把路径推离奇点邻域、或改换解支(肘上 / 肘下、肩左 / 肩右)来躲开内部奇点。一句话:规划负责不出事,算法负责出了事不失控。
评分建议:(a) 2.5 分(须点出「几何属性、换算法躲不掉」);(b) 2.5 分(须给出 adjJ/detJ 或增益 1/σ 之一,并强调「邻域」);(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 与向心项,那正是本章雅可比在时间轴上的延伸。 |
| 75–89 | 主干掌握,个别判据(如解耦矩阵的边界、DLS 前提)不稳 | 用学习目标自检表找出失分条目对应的小节,重做该节「默写点」。 |
| 60–74 | 会背绿框公式,但一换机构、一换参考点就乱 | 重做习题集 B 组与 C 组;把 3.2 三种结构的雅可比各手推一遍,并用中心差分自检(make verify 同一方法)。 |
| < 60 | 需要系统性重学 | 回到章节导览,按「3.1 → 3.2 → 3.3 → 3.8」的顺序重读(这四节是必考主干),再补 3.5 与 3.6。 |
复盘比分数重要
无论得多少分,做完后请为每道错题写一行复盘,格式固定为一句话:
「我在 ____ 这一步错了,原因是 ____,正确做法是 ____。」
如果同一类错误出现两次以上——尤其是「zi−1 当 [0,0,1]T」「矢径方向或顺序写反」「用 J−1 / J† 传力」「解耦矩阵拿去做逆解」「把三味药混用」「把奇点当数值 bug」「转置方案按完全线性化设计增益」这七类——那不是粗心,而是概念缺口。回到对应小节重读,而不是多做题。