B05 · 位置逆运动学 · 单页课件
移动苹果,看算法怎样一步步找到它
本课时的问题是:移动苹果,看算法怎样一步步找到它。右栏内容主体取自本站 B05 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「位置逆解:一步步逼近目标」把本课时的核心关系画成可拖、可读数的交互图。
内容主体:本站 B05 课时讲义(依据公开教程与本地课件重新组织) | 配套:① 原站点 G1 演示 + ② 本课时概念交互台
本版怎么操作 Modern Robotics §6.2 / 数值逆运动学
- 拖动苹果看快速候选预览
- 计算候选并逐步回看迭代
- 确认有效候选后应用到实际机器人
逆解是在当前初值附近寻找满足目标的关节角。蓝色虚影是算法候选,实体是当前机器人。把两者分开,才能看清算法试探、收敛与实际状态改变是不同阶段。
实验范围:位置约束;未检查碰撞。目标、参数或初态变化会使旧候选失效;失败不证明无解。
手部目标跟踪与停止条件
拖动苹果或输入世界坐标,先手动试着调几个关节,再运行位置逆解。单步按钮显示一次线性化修正,全程按钮记录位置误差随迭代的变化。这里的成功只表示手心位置误差小于 1 mm;手掌朝向没有被约束。
从正解误差反求一小步
当前 q 先算出 p(q),目标与当前之差为 e。用位置雅可比近似 p(q+Δq)≈p(q)+J_vΔq,再通过阻尼最小二乘找一小步。模型有七个关节,而位置任务只有三个分量,因此需要选取一个数值解,并裁剪关节范围、缩短不能降低误差的步长。
用已知答案检验求解器
先给一组合法关节角 q*,计算 p*=FK(q*),再从另一初值求 p*。算法不必回到 q*,但最终 FK 必须重建目标位置。若目标距手 3 cm,而一次修正预测移动 3 cm,却实际增大误差,就减小 η 后重试;这正是局部近似需要线搜索的原因。
失败读数也是实验结果
本页显示剩余误差、迭代数和最后姿态,允许改变初值与阻尼后再试。目标远离点云、关节被限位、雅可比接近奇异,都可能阻碍收敛。“预算内未收敛”不能写成“数学上无逆解”。目标改变后原结果立即失效,避免把旧成功标记当作新目标的答案。
出处 · 本课时内容来源
- 内容主体 本站
b05.html课时讲义,按原有章节顺序完整展开;讲义依据公开教程与本地数学基础课件重新组织,非教材章节扫描件。 - ① 兴趣引入 站点原有 G1 三维实验台,通过
?embed=topic嵌入模式复用,未改写原页面代码。 - ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本课时核心关系;教学示意模型,不是真实机器人仿真。
- 延伸阅读 MR 6.2 数值逆运动学 ↗ ↗
- 延伸阅读 MIT Manipulation: Differential IK ↗ ↗
本页由 A01 单页课件模式批量生成;32 个课时各自独立存放,旧版文件未覆盖。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。