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

p(s) 线性插值,R(s) 用矩阵指数插值,位置与朝向各走各的。

本课时核心关系 · 讲义原式R(s)=R₀ Exp[s Log(R₀ᵀR₁)]
看什么:拖动 s,观察末端点沿直线走,而工具轴方向按测地线旋转;位置到终点时朝向未必同步到位。

D04 · 笛卡尔位姿轨迹 · 单页课件

沿着路线走,手掌方向也要保持合适

本课时的问题是:沿着路线走,手掌方向也要保持合适。右栏内容主体取自本站 D04 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「笛卡尔位姿轨迹」把本课时的核心关系画成可拖、可读数的交互图。

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

怎么用左边两个演示:先在 ① 里动手试一次,把问题提出来;再到 ② 里拖参数,看图形与读数怎样随核心关系变化。拖动 s,观察末端点沿直线走,而工具轴方向按测地线旋转;位置到终点时朝向未必同步到位。 右栏的「在 ② 里看」按钮会把概念台切到对应预设。

本版怎么操作 Modern Robotics §9.4 / SE(3) 插值

  1. 摆放苹果并改变到达时掌面角度
  2. 生成笛卡尔位姿路径
  3. 逐帧观察位置、方向与逆解连续性

位置与姿态需要一起规划。旋转插值沿相对旋转的短路径变化,逐点求解时沿用前一节点初值,可以降低突然换解支路的风险;仍须拒绝过大的关节跳变。

讲义原式 · D04R(s)=R₀ Exp[s Log(R₀ᵀR₁)]

实验范围:离散位置/姿态插值及顺序IK;失败节点会中止整条计划,未执行碰撞检查。

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

手沿直线走,姿态也要平稳转过去

位置起点与终点之间用直线插值;姿态沿 SO(3) 的最短旋转插值。每个路径节点使用上一个 IK 解作初值。观察一条看似简单的笛卡尔路线,如何在关节空间变得弯曲,甚至因限位或局部奇异在中间节点失败。

两种空间分别插值

平移属于欧氏空间,可以线性插值。旋转矩阵逐元素线性插值一般会离开 SO(3),所以本页通过旋转对数与指数映射构造中间姿态。目标姿态矩阵保持正交、行列式为 1,但这并不保证机器人每个节点都有可接受的逆解。

讲义原式 · D04p(s)=(1−s)p₀+sp₁ R(s)=Exp[s Log(R₁R₀ᵀ)] R₀

用中间点揭示端点之外的限制

假设两个端点都能达到,中间的空间直线却穿过不可达区或障碍,端点成功不能替整段背书。这里逐节点检查位置、姿态误差和相邻关节最大跳变;失败就记录节点编号并禁止把残缺路线当作成功轨迹播放。

离散路线仍有边界

页面显示采样 TCP 路径与最大误差。回放在已求得的关节节点之间插值,节点间的 TCP 可能略偏离目标直线。速度估计来自节点差分,不是解析光滑轨迹;碰撞、加速度连续性和动力学可执行性还需要后续处理。

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

出处 · 本课时内容来源

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

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