R机器人实验室ROBOTICS ATLAS
模块 / M31 / 非完整约束、微分约束与可行轨迹
v2 课件目录完整实验台 ↗
① G1 实验台 · A05兴趣引入 · 复用原站点演示 复用本站 A05 课时真实 G1 人形实验台;先看整机,再回到本章的人形问题
独立打开 ↗
② 差速底盘:轮速决定轨迹概念演示 · 与本模块同步 拖参数,看图形与读数

左右轮速度一差,机器人就走圆弧;两轮反走可以原地转身。

本模块核心关系 · 教学示意A(q)q̇ = 0 ; q̇ ∈ null(A(q)) ; min ∫L(x,u)dt s.t. ẋ=f(x,u)
看什么:v=(v_L+v_R)/2、ω=(v_R−v_L)/b;v=0 时是原地旋转,半径公式会退化。

模块 M31 · L7 运动规划 · 必修 · 单页课件

非完整约束、微分约束与可行轨迹

能区分完整 / 非完整约束,写出 Pfaffian 约束与可行速度锥,说明为什么平滑一条路径不等于让它可执行。

内容主体:本科机器人学课程体系 v2(Craig 骨架 · 路径轨迹与控制扩展)中的章节正文;以 G1 人形机器人为贯穿案例 | 配套:① 原站点演示 + ② 本模块概念交互台

怎么用左边两个演示:先在 ① 的真实 G1 人形平台上动手试一次,把本章的人形问题提出来;再到 ② 里拖参数,看图形与读数怎样随核心关系变化。① 是本站已有真实实验台,用作兴趣 / 问题引入,不是本模块专属仿真;② 才与本模块核心关系直接对应。右栏的「在 ② 里看」按钮会把概念台切到对应预设。

人形机器人 · 本章引入 G1 案例

差速底盘规划出的横向平移曲线,做再多糖的平滑也走不出来——非完整约束限制的是速度,不是曲线好不好看。

① 的真实 G1 三维实验台是这一章的兴趣引入:先在左栏看整机的姿态与读数,把「这台人形机器人为什么需要本章」提出来;再到 ② 把核心关系亲手拖一遍。

本节要解决的问题 章节定位

差速车规划出的横向平移曲线,为什么做再多糖的平滑也无法执行?

为什么独立成章:「路径平滑」只是连续性后处理,不能保证运动可执行;本章把它换成约束下的可行轨迹问题,并与 L5 的轨迹优化相接。

知识层级L7 · 运动规划
课程性质本科必修 · 3 学时
学习结果能区分完整 / 非完整约束,写出 Pfaffian 约束与可行速度锥,说明为什么平滑一条路径不等于让它可执行。
概念台模型vehicle

概念辨析 5 组

完整 vs 非完整完整约束可积分成构型空间的几何限制;非完整约束限制的是速度,不能积分成位置约束。
Pfaffian 约束A(q)q̇ = 0;允许的速度构成分布 / 零空间,规划必须在这个子空间里取方向。
可行轨迹除了几何无碰撞,还要满足速度 / 加速度 / 力矩与执行器动力学约束;「平滑」只改善连续性,不能保证动力学可行。
与轨迹优化的接口L7 给几何路径,L5 的 M48 在同一路径上求可行且最优的时间律;两层分工明确。
典型例子差速车不能横移、汽车最小转弯半径、机械臂关节力矩限;都是约束而非「曲线不好看」。

核心关系式 Siegwart《Introduction to Autonomous Mobile Robots》

式 (M31.1)A(q) q̇ = 0 ⇒ q̇ ∈ null(A(q))

非完整约束下的可行速度集合。

式 (M31.2)ẋ = f(x, u) , u ∈ U

微分约束的一般形式,规划与最优控制共用。

式 (M31.3)min ∫ L(x,u) dt s.t. ẋ = f(x,u), g(x,u) ≤ 0

把「让轨迹可执行」写成带约束的优化,而不是后处理平滑。

↔ 概念演示先把第一组条件放到 ② 里亲手拖一遍。

方法与步骤

  1. 先列出所有约束,再判断哪些是几何层、哪些是速度 / 动力学层。
  2. 用可行速度锥筛选采样方向,而不是先采样再平滑。
  3. 把几何路径交给 M48 求时间律,并把不可行点反馈回规划层。

工程例子 把式子落到真实约束上

差速车规划出一条漂亮的横向平移曲线,几何上无碰撞,但车辆没有横移自由度;把它做再多糖的平滑也无法执行,必须在采样阶段就限制在可行速度锥内。

非完整约束 A(q)q̇ = 0 限制的是速度而非位置;可行轨迹还须满足速度 / 加速度 / 力矩约束,「平滑」只是连续性后处理。

↔ 概念演示换一组预设,看关系在不同条件下怎样变化。

② 概念台怎么读

差速底盘:轮速决定轨迹。左右轮速度一差,机器人就走圆弧;两轮反走可以原地转身。

看什么:v=(v_L+v_R)/2、ω=(v_R−v_L)/b;v=0 时是原地旋转,半径公式会退化。

滑块分别改变 左轮速度 v_L、右轮速度 v_R、运动时长 T;读数板列出中间量与判定。预设「前进弯弧」等对应最容易出错的几组条件。

概念台边界:② 复用轮式运动学实验台看「左右轮速度 → 实际轨迹」的约束;可行速度锥与微分约束优化式在右栏给出。

章节依据 可逐条追溯

主干 / 主补充:

  • CHOSET Ch11–12 非完整与欠驱动规划
  • LAVALLE Ch13–14 微分约束
  • BIAGIOTTI Ch9 从几何路径到轨迹

其他参照:AMR Ch3 轮式运动学约束;MIT Underactuated Ch10 轨迹优化

先修链 显式 DAG

M30采样规划 PRM / RRT 与图搜索(L7)
M21拉格朗日方程、笛卡尔动力学与仿真(L4)

先修关系写在 curriculum-craig-v2/curriculum.json 的 prereq 字段,50 个模块整体无环、可直接拓扑排序。

编写状态与使用边界 如实标注

页面形态:A01 单页两栏课件 右栏:章节讲义教学版(概念 / 公式 / 方法 / 例子) ① 真实 G1 演示:兴趣 / 问题引入 ② 概念交互台:与本模块核心关系对应 教材正文:未复制、未镜像

使用边界:商业教材只登记公开目录、算法事实与公式;① 是本站已有真实交互实验台,用作兴趣 / 问题引入,不是本模块专属仿真;② 是教学示意模型,数值用于观察关系,不作为工程计算结果。

自测 · 掌握证据

题目:为什么对非完整系统「先规划再平滑」常常无效? L7 的几何路径与 L5 的时间律分别负责满足哪一类约束?

提示:从 ② 里找证据

先在概念台里复现一组典型条件,再用核心关系式逐项核对读数;能说清「哪个量变了、哪个量没变、为什么」,才算达到本模块的掌握证据。

出处 · 本模块内容来源

  • 内容主体 curriculum-craig-v2/curriculum.json 与 01_课程体系大纲_路径轨迹与控制扩展.md 中的章节 M31;主干教材为 Craig《Introduction to Robotics》4/e。
  • ① 兴趣引入 站点原有 G1 三维实验台 a05.html,通过 ?embed=topic 嵌入模式复用,未改写原页面代码。
  • ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本模块核心关系;教学示意模型,不是真实机器人仿真。
  • 主干 / 主补充章节(可逐条追溯) CHOSET Ch11–12 非完整与欠驱动规划;LAVALLE Ch13–14 微分约束;BIAGIOTTI Ch9 从几何路径到轨迹
  • 其他参照 AMR Ch3 轮式运动学约束;MIT Underactuated Ch10 轨迹优化
使用边界:本页按 v2 大纲逐节展开概念辨析、核心关系式、方法步骤与工程例子,是章节讲义的教学版,不是教材正文的复制;商业教材只用公开目录、算法事实与公式。Craig / Biagiotti / Siciliano / Ogata 等为商业教材;MIT OCW 与作者公开预印本按各自许可引用。概念台数值用于观察关系,不作为工程计算结果。

本页按 A01 单页课件模式生成,承载 v2 体系重写 / 新增的扩展章节;17 份课件独立存放在全新目录,v1 体系、19 份缺口课件、32 份课时课件与 91 模块课件一份未动。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。