D04 · 笛卡尔位姿轨迹 · 单页课件
沿着路线走,手掌方向也要保持合适
本课时的问题是:沿着路线走,手掌方向也要保持合适。右栏内容主体取自本站 D04 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「笛卡尔位姿轨迹」把本课时的核心关系画成可拖、可读数的交互图。
内容主体:本站 D04 课时讲义(依据公开教程与本地课件重新组织) | 配套:① 原站点 G1 演示 + ② 本课时概念交互台
本版怎么操作 Modern Robotics §9.4 / SE(3) 插值
- 摆放苹果并改变到达时掌面角度
- 生成笛卡尔位姿路径
- 逐帧观察位置、方向与逆解连续性
位置与姿态需要一起规划。旋转插值沿相对旋转的短路径变化,逐点求解时沿用前一节点初值,可以降低突然换解支路的风险;仍须拒绝过大的关节跳变。
实验范围:离散位置/姿态插值及顺序IK;失败节点会中止整条计划,未执行碰撞检查。
手沿直线走,姿态也要平稳转过去
位置起点与终点之间用直线插值;姿态沿 SO(3) 的最短旋转插值。每个路径节点使用上一个 IK 解作初值。观察一条看似简单的笛卡尔路线,如何在关节空间变得弯曲,甚至因限位或局部奇异在中间节点失败。
两种空间分别插值
平移属于欧氏空间,可以线性插值。旋转矩阵逐元素线性插值一般会离开 SO(3),所以本页通过旋转对数与指数映射构造中间姿态。目标姿态矩阵保持正交、行列式为 1,但这并不保证机器人每个节点都有可接受的逆解。
用中间点揭示端点之外的限制
假设两个端点都能达到,中间的空间直线却穿过不可达区或障碍,端点成功不能替整段背书。这里逐节点检查位置、姿态误差和相邻关节最大跳变;失败就记录节点编号并禁止把残缺路线当作成功轨迹播放。
离散路线仍有边界
页面显示采样 TCP 路径与最大误差。回放在已求得的关节节点之间插值,节点间的 TCP 可能略偏离目标直线。速度估计来自节点差分,不是解析光滑轨迹;碰撞、加速度连续性和动力学可执行性还需要后续处理。
出处 · 本课时内容来源
- 内容主体 本站
d04.html课时讲义,按原有章节顺序完整展开;讲义依据公开教程与本地数学基础课件重新组织,非教材章节扫描件。 - ① 兴趣引入 站点原有 G1 三维实验台,通过
?embed=topic嵌入模式复用,未改写原页面代码。 - ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本课时核心关系;教学示意模型,不是真实机器人仿真。
- 延伸阅读 MR 9.1/9.2 几何路径 ↗ ↗
本页由 A01 单页课件模式批量生成;32 个课时各自独立存放,旧版文件未覆盖。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。