R机器人实验室ROBOTICS ATLAS
课时 / B05 / 位置逆运动学
全部课时完整实验台 ↗
① 位置逆运动学 · G1兴趣引入 · 原站点演示 场景内可切视角;下方选参考系、放预测点并看读数
独立打开 ↗
② 位置逆解:一步步逼近目标概念演示 · 与本课时同步 拖参数,看图形与读数

e = p_des − p(q),用 J 的伪逆把位置误差折算成关节增量。

本课时核心关系 · 讲义原式e_p = p_target − p(q);Δq = Jᵀ(JJᵀ+λ²I)⁻¹e_p
看什么:移动目标点,看误差 e 与所需 Δq 如何变化;接近工作空间边界时,同样的位移需要更大的关节变化。

B05 · 位置逆运动学 · 单页课件

移动苹果,看算法怎样一步步找到它

本课时的问题是:移动苹果,看算法怎样一步步找到它。右栏内容主体取自本站 B05 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「位置逆解:一步步逼近目标」把本课时的核心关系画成可拖、可读数的交互图。

内容主体:本站 B05 课时讲义(依据公开教程与本地课件重新组织) | 配套:① 原站点 G1 演示 + ② 本课时概念交互台

怎么用左边两个演示:先在 ① 里动手试一次,把问题提出来;再到 ② 里拖参数,看图形与读数怎样随核心关系变化。移动目标点,看误差 e 与所需 Δq 如何变化;接近工作空间边界时,同样的位移需要更大的关节变化。 右栏的「在 ② 里看」按钮会把概念台切到对应预设。

本版怎么操作 Modern Robotics §6.2 / 数值逆运动学

  1. 拖动苹果看快速候选预览
  2. 计算候选并逐步回看迭代
  3. 确认有效候选后应用到实际机器人

逆解是在当前初值附近寻找满足目标的关节角。蓝色虚影是算法候选,实体是当前机器人。把两者分开,才能看清算法试探、收敛与实际状态改变是不同阶段。

讲义原式 · B05e_p = p_target − p(q);Δq = Jᵀ(JJᵀ+λ²I)⁻¹e_p

实验范围:位置约束;未检查碰撞。目标、参数或初态变化会使旧候选失效;失败不证明无解。

↔ 概念演示把讲义里的关系放到 ② 里亲手拖一遍,读数会随参数实时变化。

手部目标跟踪与停止条件

拖动苹果或输入世界坐标,先手动试着调几个关节,再运行位置逆解。单步按钮显示一次线性化修正,全程按钮记录位置误差随迭代的变化。这里的成功只表示手心位置误差小于 1 mm;手掌朝向没有被约束。

从正解误差反求一小步

当前 q 先算出 p(q),目标与当前之差为 e。用位置雅可比近似 p(q+Δq)≈p(q)+J_vΔq,再通过阻尼最小二乘找一小步。模型有七个关节,而位置任务只有三个分量,因此需要选取一个数值解,并裁剪关节范围、缩短不能降低误差的步长。

讲义原式 · B05e = p_des − p(q) Δq = J_vᵀ(J_vJ_vᵀ+λ²I)⁻¹e q_next = clip(q + ηΔq, q_min, q_max)

用已知答案检验求解器

先给一组合法关节角 q*,计算 p*=FK(q*),再从另一初值求 p*。算法不必回到 q*,但最终 FK 必须重建目标位置。若目标距手 3 cm,而一次修正预测移动 3 cm,却实际增大误差,就减小 η 后重试;这正是局部近似需要线搜索的原因。

失败读数也是实验结果

本页显示剩余误差、迭代数和最后姿态,允许改变初值与阻尼后再试。目标远离点云、关节被限位、雅可比接近奇异,都可能阻碍收敛。“预算内未收敛”不能写成“数学上无逆解”。目标改变后原结果立即失效,避免把旧成功标记当作新目标的答案。

↔ 概念演示把讲义里的关系放到 ② 里亲手拖一遍,读数会随参数实时变化。

出处 · 本课时内容来源

  • 内容主体 本站 b05.html 课时讲义,按原有章节顺序完整展开;讲义依据公开教程与本地数学基础课件重新组织,非教材章节扫描件。
  • ① 兴趣引入 站点原有 G1 三维实验台,通过 ?embed=topic 嵌入模式复用,未改写原页面代码。
  • ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本课时核心关系;教学示意模型,不是真实机器人仿真。
  • 延伸阅读 MR 6.2 数值逆运动学 ↗ ↗
  • 延伸阅读 MIT Manipulation: Differential IK ↗ ↗
使用边界:Modern Robotics 预印本扉页声明 "personal use only and not for further distribution";本套课件只引用公开教程链接与本站自有讲义,不复制教材章节正文、不镜像 PDF。概念台的数值为教学示意,用于观察关系,不作为工程计算结果。

本页由 A01 单页课件模式批量生成;32 个课时各自独立存放,旧版文件未覆盖。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。