H03 · 全身任务与接触约束 · 单页课件
手要去够苹果,脚与电机允许吗?
本课时的问题是:手要去够苹果,脚与电机允许吗?。右栏内容主体取自本站 H03 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「全身任务与接触约束」把本课时的核心关系画成可拖、可读数的交互图。
内容主体:本站 H03 课时讲义(依据公开教程与本地课件重新组织) | 配套:① 原站点 G1 演示 + ② 本课时概念交互台
本版怎么操作 Modern Robotics §11.6 / 带约束的全身控制
- 拖动苹果改变三维手部加速度意图
- 求解并比较橙色期望与绿色实现值
- 降低摩擦或电机力矩界,观察任务偏差和约束边界
全身任务必须同时满足浮动基座动力学和接触约束。手想加速不代表足底能提供所需反力。优化器在约束内折中任务,任务残差本身就是有用的解释。
实验范围:零速度瞬时QP,不推进步态;双足零加速度与足底力矩范围为教学假设,摩擦采用线性金字塔。
手向前伸,脚和关节力矩还能同时满足约束吗
把手部期望加速度与双足不动放在同一个瞬时优化问题里。调大手任务权重后,任务误差通常减小,但硬约束仍必须满足。再降低摩擦系数或电机力矩限值,观察求解器报告可行结果、任务残差或约束失败。
把硬条件和软目标分开
本页在零速度状态求解浮动基座加速度和双足六维接触力旋量。基座动力学、足端零加速度是等式约束;法向力非负、线性摩擦锥近似、足底力矩界与电机力矩界是硬不等式。手部加速度和小的关节加速度正则项进入代价函数。改变权重不能合法地违反硬条件。
残差是答案的一部分
若手部期望加速度为 1.2 m/s²,求得 1.0 m/s² 且所有硬约束满足,这是折中最优结果,不是“精确完成手任务”。若硬约束冲突,必须明确报告失败,不显示上次成功的力箭头。本页报告等式残差、最大不等式违反量和手足任务残差。
为什么这里只解一个瞬时问题
足底接触模式、力矩支撑范围和摩擦系数是明确的教学假设,六维接触力作用点取脚踝前方 0.035 m 的地面点;假定该点周围存在世界水平的矩形支撑片,半长 0.07 m、半宽 0.025 m。这是明确给定的接触支撑近似,不是实时辨识的足底压力分布。当前速度固定为零,所以省略 J̇v;状态变化后需要重算全部项。这里没有把瞬时 QP 解积分成行走控制,没有步态状态机,也没有给出动态稳定性保证。
出处 · 本课时内容来源
- 内容主体 本站
h03.html课时讲义,按原有章节顺序完整展开;讲义依据公开教程与本地数学基础课件重新组织,非教材章节扫描件。 - ① 兴趣引入 站点原有 G1 三维实验台,通过
?embed=topic嵌入模式复用,未改写原页面代码。 - ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本课时核心关系;教学示意模型,不是真实机器人仿真。
- 延伸阅读 MIT Underactuated: Multi-Body Dynamics ↗ ↗
- 延伸阅读 Kuindersma等:An Efficiently Solvable Quadratic Program for Stabilizing Dynamic Locomotion ↗ ↗
本页由 A01 单页课件模式批量生成;32 个课时各自独立存放,旧版文件未覆盖。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。