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

给定关节角,末端位置是唯一确定的。

本课时核心关系 · 讲义原式q → T_WH(q)
看什么:只拖 θ₁、θ₂,末端点随之移动;反过来挪目标点并不会让手臂动起来——那是逆运动学要做的事。

B01 · 正运动学 · 单页课件

自己调肩、肘、腕,让手接近苹果

本课时的问题是:自己调肩、肘、腕,让手接近苹果。右栏内容主体取自本站 B01 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「正运动学:角 → 位置」把本课时的核心关系画成可拖、可读数的交互图。

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

怎么用左边两个演示:先在 ① 里动手试一次,把问题提出来;再到 ② 里拖参数,看图形与读数怎样随核心关系变化。只拖 θ₁、θ₂,末端点随之移动;反过来挪目标点并不会让手臂动起来——那是逆运动学要做的事。 右栏的「在 ② 里看」按钮会把概念台切到对应预设。

本版怎么操作 Modern Robotics §4.1 / Craig Ch.3 · 正运动学

  1. 摆放苹果
  2. 点肩、肘、腕并手动调角度
  3. 观察误差线,必要时将同一目标带到逆运动学页

正运动学把关节角映射到手的位置和朝向。先亲自调多个关节,可以体会变量耦合:某个角变了,手可能沿弧线移动,其他方向也会改变。苹果只是用来衡量结果的参照。

讲义原式 · B01q → T_WH(q)

实验范围:苹果移动不会自动求逆解;当前页不检测抓握或碰撞。

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

手心为什么没有沿关节轴走直线

目标苹果固定在世界中。逐个改变肩、肘和腕角度,先预测手心的大致方向,再观察轨迹。某些腕关节旋转时,腕原点的位置不变,但手心仍移动,因为教学手心位于腕局部 x 正向 0.14 m。本页固定使用左臂,另一只手可作为不随左臂关节变化的参照。

正运动学是一条确定的计算链

给定所有关节位置 q,沿刚体树从基座到工具连乘,得到位置 p(q) 与姿态 R(q)。末端姿态不能从三个位置数恢复。每次改变一个关节,要先确认该关节是否位于所选手的祖先链上。这里读取实际 G1 模型的刚体变换,关节范围来自模型,而不是另外画一支长度近似的手臂。

讲义原式 · B01T_WH(q) = T_WB T_B1(q₁) … T_7K(q₇) T_KH p_WH = p_WK + R_WK [ℓ,0,0]ᵀ

用工具偏置检查结果

设腕原点是 (0.20,0.10,1.00) m,腕的 x 轴在世界中指向 +y。当 ℓ=0.14 m 时,手心为 (0.20,0.24,1.00) m。增加偏置到 0.20 m,只沿该轴再走 0.06 m。把偏置直接加在世界 x 上,仅在腕轴恰与世界轴重合时才碰巧正确。

为什么“七个数到六个数”仍有意义

空间位姿只有六个局部自由度,但七个关节仍可以确定它。不同 q 可能给出相同末端位姿;这不影响正运动学的确定性,却使逆问题可能有多解。保存一组关节角,在 B05 和 B06 用它生成一个已知可达的逆解测试目标。

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

出处 · 本课时内容来源

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

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