主题
抓放任务的语义与执行边界
方块抓放的任务判定与动作策略分开。理论依据是 TAMP 的离散/连续约束、BDDL 的对象与目标条件、STL 的时间和不完整轨迹语义,实现采用 JAX 所倡导的显式状态输入/输出。当前是纯 Python 参考实现,没有声称实现完整 STL、JAX 批处理或力闭合证明。
有限执行的生命周期
有限物理执行沿用 ROS 2 Action 的 Goal 语义: accepted、executing、canceling、succeeded、aborted、canceled。字段及校验的权威定义在 pride_core.actions;pride_runtime.goal.Goal 仅由物理拥有线程推进,网页不另行判断终态。 当前非 ROS worker 继续通过私有 gRPC 传输这些事实,不宣称已经提供原生 ROS Action server。
每个 episode 有独立 goal UUID。输入验证和登记完成后为 accepted,开始执行为 executing。 物理步预算结束、任务判定结束或物理无效时,执行端冻结判定,进入 finalizing 阶段; 状态仍为 executing。之后的 stop_task 返回 ERROR_REJECTED,不把已完成工作改写为取消。 接受停止请求则进入 canceling,在合法物理步边界冻结推进;这只确认仿真不再推进,不代表实机停稳。 只有必需记录与该执行作用域的清理完成后,才能发布 succeeded 或 canceled;任一项失败为 aborted。 进程信号或强制回收不是协作取消确认。
result.json.execution 保存唯一任务终态,并分别记录 cancel_accepted、recording、cleanup 结果和执行错误。 取消已接受后若记录或清理失败,终态为 aborted,cancel_accepted 仍为 true;停止请求和取消应答也写入命令记录。 任务判据、物理有效性保留独立字段;记录/关闭失败不会抹掉已取得的任务测量。 独立 worker 的 backend.close 属于发布终态前的必要清理;reset 归档只结束 episode, 共享后端继续存在,其 cleanup 明确为 not_applicable。 manifest.status=completed 仅表示记录归档完成,不能据此推出任务成功或取消。 外部进程拥有者另写 process.json 的实际退出码和是否强制回收,不改写 worker 的终态。 执行端结果缺失或校验失败时,观察端保留最后已知状态并标记结果不可取得;不得补造 canceled/aborted。
Goal 终态发布后不可修改。网页 cancel 只设置 cancel_requested 并返回 cancel_requested 回执; 执行端的 stop_task 回复独立携带标准取消返回码与 goals_canceling。 连续遥操会话、设备生命周期和进程生命周期不套用 Goal 状态。
当前可执行契约
世界仍可用 s=(m,x) 表达;物理关系/模式 m、连续状态 x、判定需要的历史、控制器阶段分别拥有明确语义。
抓放契约要求先观察到指定源支撑体提供支撑,再观察到抓持、抬升及脱离该支撑体;最后对象在目标位置得到支撑、无手部接触、低速,并持续满足规定时间。抓起后失去抓持且未得到支撑、相对漂移超限、禁止接触或超时会违反契约。不能把初始就在目标位置的静止对象算作完成抓放。
本契约要求当前终点满足稳定放置,早先曾满足而后又失去支撑不算最终成功。接触缺失、过期、不完整、未绑定实体或采样中断使整段过程无法获得完整证据;后续正常数据不会把这个缺口抹掉。判定针对采样轨迹,不证明采样之间的连续行为。
| 状态 | 含义 |
|---|---|
pending | 证据尚未满足任务要求,例如还未抓起或稳定窗口尚未结束 |
satisfied | 已有规定的抓起历史,当前终点满足稳定放置,过程证据完整且无已知违反 |
inconclusive | 必需的过程证据缺失,不能据此宣称完成 |
violated | 已观察到禁止接触、掉落、超限滑移或时间预算违反 |
事实仍使用 true / false / null;契约状态与单个事实的真值不同。released=null 表示无法判断接触,pending 可以表示全部当前测量有效但持续时间还不够。
代码与所有权
| 入口 | 输入与输出 | 负责什么 |
|---|---|---|
pride_core.semantics.measure | 固定绑定、State、诊断 → 不可变 Measurements | 提取接触、相对位姿、误差、速度和有效性;不读取控制器阶段 |
pride_core.semantics.monitor | ObservationSpec、MonitorState、Measurements → 新 carry、SemanticFrame | 接触宽限期、相对漂移、持续时间与事实;不修改输入 |
pride_core.tasks.pick_place.evaluate | PickPlaceSpec、TaskMemory、Measurements → 新 carry、事实、Verdict | “先支撑再抓起再放稳”的轨迹契约与全过程约束 |
pride_runtime.evaluation.TaskEvaluator | PhysicsFrame → TaskEvaluation;策略进度 → 任务结果 | 持有 episode 的 TaskMemory,独立于策略阶段更新证据并合成结果 |
pride_runtime.pick_place.PickPlacePolicy | job、计划、状态与 TaskEvaluation → 关节目标、策略进度 | 阶段机、轨迹样本与协作检查;目标必须匹配契约,重规划不能改验收目标 |
pride_runtime.visual_pick_place.VisualPickPlacePolicy | 规划接口、相机观察源、状态与 TaskEvaluation | 视觉获取、重规划与协作;不持有物理后端,不拥有判据历史 |
pride_runtime.manipulation.TaskStepper | PhysicsSession、Policy、记录器 | 控制/物理时钟;先检查物理有效性,再更新评估、记录测量、推进策略 |
pride_core.task_audit.audit_run | 完成的 run / episode | 校验哈希并从逐步测量重新计算契约和末帧事实,不启动引擎或执行策略 |
TaskEvaluator 独立持有 TaskMemory,策略保存自身阶段,记录器保存轨迹。视觉策略尚在获取图像、尚未创建子策略时,评估和逐步测量记录已开始;子策略创建、重规划或阶段变化不会重置判据历史和任务期限。episode reset 同时重建策略、评估器及记录器,历史 episode 保留独立模型及哈希。
当前控制器仍有自身的检查点和协作要求。任务最终 success 要求策略检查通过、契约满足;运行结果另外报告物理有效性。离线审计的 consistent=true 只说明重算一致,可以与 task_success=false 同时出现。
数据布局与性能边界
交互会话在任务成功、失败或操作员停止后冻结当前 episode;后续 advance 在发送关节目标前拒绝。status 和 close 仍可使用,reset 先归档终态再开始新 episode。无任务的手动推进也在步数耗尽后拒绝继续,避免物理末帧超出任务证据终点。
实体名到机器人角色的解析只在 compile_pick_place 中进行。准备产物保存 body_names,job 验证核对模型中的同一字段。每步只访问对象/末端数据和当前接触,不再扫描所有实体名称。数值事实使用固定字段 NamedTuple/dataclass;predicate_document 只在事件、快照或下载边界构造带解释的字典。
所有被任务处理的物理步都会保存不可变测量。轨迹和测量最多累积 256 行后转交容量为 8 块的单写入线程,运行中通过官方 Rerun SDK 分块写入;契约保存在 task_contract.json,测量保存为 task_measurements.rrd。物理线程不逐步编码 JSON 或写盘;缓冲耗尽停止推进并报告错误,收尾有界等待后保留已接受数据,不能以丢证据继续运行。两者与结果一起进入 manifest 哈希。显示轨迹仍按原记录频率采样,因此不能用显示轨迹替代完整语义测量。
几何构建和显示按“源资源 → 全部实例”批量处理,删除按需 mesh/STEP 计算缓存;模型凸包直接归属该模型目录,移除共享全局 hull 命中路径和 CAD 凸包的重复转换。模型打包按唯一来源复制。源 SolidCraft 文件中的 cache/ 是原始格式,旧 run 引用的 hull 是历史模型依赖;这些文件保留,不作为新构建的缓存。
当前仍是单世界 CPU 参考路径。None、字符串、Python 对象以及输出时的 JSON 不构成可直接 JIT/vmap 的 GPU 核;当前没有固定形状的批量环境状态接口。固定接触容量溢出必须显式表示证据不完整。必要的时序 carry、原始回放数据与已送达相机帧都有状态语义,不能作为 memoization 删除。
判据能力边界
- 支撑目前是正 world-Z 冲量,不是静力/力矩平衡证明;倾斜表面需要新的定义。
- 抓持是分组接触和抬升后的有界相对漂移,不是 force closure;滑移是对象相对末端漂移,不是局部接触滑移。
- 到位目前使用位置误差;移液需要局部坐标系、姿态、插入深度、吸头/液面证据和经验证的量程容差。
audit从已经提取的测量重算时间与任务逻辑,不重新处理原始图像、接触求解或硬件数据,也不验证仿真真实性。- 遥操或 RL 可以独立提供同一契约的观测序列;当前没有实现真实遥操导入器、液体模型、WM 或训练环路。
验收
对完成的 run 或 reset 后的 episode 执行 audit,分别核对:
consistent=true:哈希通过,逐步测量重算的契约及末帧事实与在线记录一致。contract.status=satisfied:契约达标;其他状态的含义见上文。physical_validity.valid=true与task_success=true:物理检查和整项任务分别通过,不能由审计一致代替。
缺少逐步测量时 audit 应拒绝,证据被篡改时哈希检查应失败。独立判定、分块恢复、缺证据反例及真实后端的检查范围统一见验证指南,物理任务产物见Isaac Lab 集成。
浏览器验收需实际操作模型选择、求解、任务提交、取消和导出;Rerun 回放需核对轨迹、采集/送达时钟与判据时间。协议测试或静态预览不能代替这些证据,也不证明移液真实性、力闭合、真实遥操或 WM / RL 效果。