分层控制

“EICPS 是 MES\mathcal{M}_{ES} 流形上的交通警察——它的任务是确保系统状态的演化轨迹,始终满足混合动力系统的约束。“

理论基础

设计动机:解决能力错配

莫拉维克悖论在具身智能中的现代表现是能力错配(Capability Mismatch)——系统上层有博士级语义规划能力,底层却只有幼儿级运动控制能力。

EICPS 仿生了生物进化给出的答案:脑-脊-体三层分工。生物神经系统历经数亿年筛选,通过分层隔离语义空间与物理空间,实现了两者的协同。

三层架构定义

SEICPS={Brain,Spine,Body,Bus}S_{EICPS} = \{\text{Brain}, \text{Spine}, \text{Body}, \text{Bus}\}
云端大脑(Brain)── VLA 层 ──  𝓜ₛₑₘ  ── 语义规划   (秒级,~1Hz)
        ↕ 接口 A:语义-动力学界面(异步·离散)
数字脊髓(Spine)── ESP 层 ──  𝓜ₚₕᵧ  ── 实时控制  (毫秒级,~1kHz)
        ↕ 接口 B:数字-物理界面(同步·连续)
物理本体(Body)  ──          机电液  ── 执行感知  (微秒级,~10kHz)
层次生物对应时间尺度流形核心算法
Brain(大脑)大脑皮层秒级Msem\mathcal{M}_{sem}VLA / LLM 语义规划
Spine(脊髓)脊髓反射弧毫秒级TxMphyT_x\mathcal{M}_{phy}PINN · HNN · CBF · Flow-Jump
Body(本体)肌肉骨骼微秒级Mphy\mathcal{M}_{phy}FOC 电机 · EtherCAT · DAE 求解

接口协议

两层接口划出了三个计算域的边界:

  • 接口 A(Brain → Spine):低频 · 异步 · 语义级。VLA 严禁直接输出电机扭矩——它只定义”去哪里”,Spine 计算”怎么去”。
  • 接口 B(Spine → Body):高频 · 同步 · 物理级。满足硬实时约束(1kHz),传递参考力矩 τref\tau_{ref} 和关节观测 q(t)q(t)

→ 接口报文格式与 STL 规约见 接口协议 A/B

跨频率调度:变速箱原理

EICPS 作为运行系统,核心职能是处理 “大脑 1Hz vs 本体 1kHz” 的速率失配:

  • 零阶保持(ZOH):将大脑稀疏的语义指令在控制周期内保持恒定
  • 参考轨迹插值:将路径点插值为连续的参考流形测地线
  • 状态压缩上报:将 1kHz 高频传感器数据滤波打包后上报给 VLA

EICPS 的三个实时职能

1. 状态估计——“我在哪里” 基于 EKF 或 PINN 预测器,在每个控制周期重建系统在 Mphy\mathcal{M}_{phy} 上的最优估计点 x^(t)\hat{x}(t)

2. 安全监控——“生存边界” 运行控制屏障函数(CBF)看门狗,时刻监控系统是否在安全包络内。一旦越界,立即切断 VLA 控制权,触发底层安全反射弧。

3. 模式切换——“执行 Jump” 当触发 Jump 条件时,执行平滑切换(Bumpless Transfer)算法,在数个 Flow 周期内通过插值消除控制量突变,防止电机电流冲击。


🔢 Spine 层算法实现:EKF 跨频率调度器、CBF 安全监控 QP、平滑切换(Bumpless Transfer)的完整 Python 实现,见 脑-脊-体架构

数学注记:从 Brooks 直觉到 Goebel 形式化

Brooks(1986)的包容架构(Subsumption Architecture)提供了分层控制的设计直觉——高层行为通过抑制(suppression)机制覆盖低层行为,层间无显式通信,每层自主闭环。这个架构在物理机器人上取得了成功,但 Brooks 本人的论文是纯工程描述,没有形式化的数学模型。

EICPS 接受了 Brooks 的架构原则(分层隔离 + 低层优先 + 无直接耦合),并用 Goebel et al.(2012)混合动力系统 给出正式数学表述。

时间尺度分离定理(非正式版)

设系统存在 kk 个控制层,各层的自然频率 ω1ω2ωk\omega_1 \ll \omega_2 \ll \cdots \ll \omega_k(满足至少三个数量级的分离),则:

  1. 渐近解耦:在足够大的频率比下,各层的控制律可以独立设计,跨层耦合项趋近于零(奇异摄动定理,Kokotović et al. 1986)
  2. 稳定性可组合:若每层在其时间尺度上单独稳定,则组合系统在适当条件下全局稳定(Tikhonov 定理的推广)

在 EICPS 中,ω11Hz\omega_1 \approx 1\,\text{Hz}(Brain)和 ω21kHz\omega_2 \approx 1\,\text{kHz}(Spine)之间的频率比约为 10310^3,满足奇异摄动的”大参数”条件,因此两层可以独立设计控制律——这正是 Brooks 凭工程直觉得到的结论的数学等价表述。

混合系统对应关系

Brooks 概念混合动力系统形式化EICPS 实例
行为层(Behavior layer)混合自动机的离散状态 qQq \in QBrain 发出的任务模态(检修 / 避障 / 返回基地)
抑制(Suppression)Jump 守卫 G(q)G(q) 触发离散切换CBF 触发 FAILSAFE 模态,覆盖 Brain 指令
连续执行(Behavior running)Flow 方程 x˙=f(x,u,q)\dot{x} = f(x, u, q)Spine 在当前模态下的连续控制律
层间无显式耦合Flow 集 C(q)C(q) 内无跨模态状态转移Brain 无法直接修改 Spine 的物理状态变量

这个对应关系表明,Brooks 架构和混合动力系统描述的是同一个底层物理现实——分层控制是对频率分离客观物理约束的正确工程响应,不是任意设计选择。

跨频调度(混合动力系统) 给出 Flow/Jump 的完整形式化 → 数学讲义第三讲:Flow-Jump 动力学 含 Colab 数值演示