HyperAIHyperAI

Command Palette

Search for a command to run...

机器人技术

多机器人 CBF 安全滤波器的精确可行性认证与最优责任分配

Chandan Kumar Sah Jishnu Keshavan

摘要

多机器人控制屏障函数(CBF)安全滤波器可能出现不可行问题,但一个失败的二次规划(QP)并不能说明冲突发生的原因或如何解决。为此,我们针对具有异构控制仿射动态和凸输入集的多智能体 CBF 滤波器,提出了一种精确可行性认证方法。该认证通过将安全约束所施加的需求与可用的执行器供给进行解耦,量化了可行性储备。这种分解揭示了 CBF 增益调节或增强执行能力何时能够以及何时不能解决不可行问题,并识别出导致冲突的智能体及其交互。我们进一步提出了一种算法,通过最大化最差局部可行性裕度来最优分配共享安全约束,对于多面体输入集,该算法可转化为一个线性规划。在 320 组配对闭环仿真中,所提出的分配方法将不可行控制步数从约 50% 降至 6.2%,并将违反安全的运行次数从 118/160 降至 24/160。此外,在 52 次不可行事件中,该认证识别出的交互在 94% 的情况下通过松弛恢复了可行性。

一句话总结

作者为多机器人CBF安全过滤器引入了一种精确的可行性证书,该证书将安全需求与执行器供给分离,以量化可行性储备,并给出一种最优分配算法,最大化最差局部可行性裕度,将不可行控制步数从约50%降至6.2%,将违反安全的运行次数从118/160降至24/160,同时该证书能够识别出在94%的不可行事件中,放松某个交互即可恢复可行性。

核心贡献

  • 推导出多机器人CBF过滤器的精确锥可行性证书,将逐点可行性分解为约束需求项和执行器供给项,适用于异构控制仿射动力学和凸输入集。
  • 该证书刻画了CBF增益调节或增加执行能力何时能解决不可行问题,通过对偶变量识别导致冲突的具体agent和交互,并量化额外执行能力的边际价值。
  • 提出一种基于证书的责任分配方法,最大化最差局部可行性裕度;对于多面体输入集,该问题退化为线性规划,在闭环仿真中,将不可行控制步数从约50%降至6.2%,将违反安全的运行次数从118/160降至24/160。

引言

控制屏障函数(CBF)安全过滤器提供了一种原则性的方法,在不丢弃标称控制器的情况下强制执行安全约束,但在多机器人系统中,通常需要同时满足多个成对或高阶约束。即使每个约束单独可行,它们的合取也可能不可行,而标准二次规划仅返回一个二元不可行标志,无法诊断哪个交互导致了冲突或如何解决。先前的工作包括可行性保证构造、兼容性条件、非光滑屏障组合、执行感知公式和在线自适应;最接近的方法为堆叠的常范数线性时不变屏障约束或欠驱动系统的对立高阶CBF边界提供了可行性测试,但它们没有量化约束需求与执行器供给之间的差距,也未涵盖状态依赖的法向量、任意凸输入集和多agent设置。作者推导出一个精确锥证书,刻画逐点可行性,并将约束需求与执行器供给分离,从而能够诊断不可行问题应通过CBF编码、增加执行能力还是重新分配约束责任来解决;该证书还产生分散式责任分配,最大化最差局部可行性裕度,对于多面体输入集退化为线性规划。

方法

作者为具有高阶控制屏障函数约束的分散式多agent系统开发了一种基于证书的安全过滤框架。该方法将全局可行性认证与局部责任分配分离,使每个agent能够局部行动,同时保证局部行动的集合满足所有耦合的HOCBF约束。

对于具有异构控制仿射动力学的NNN个agent系统

x˙i=fi(xi)+gi(xi)ui,uiUi,\dot{x}_i=f_i(x_i)+g_i(x_i)u_i,\qquad u_i\in\mathcal U_i,x˙i=fi(xi)+gi(xi)ui,uiUi,

每个安全约束kkk由一个屏障函数hkh_khk表示,其支撑集SkS_kSk包含影响该约束的agent。对于具有统一相对阶rkr_krk的约束,作者构造了HOCBF链

ψk,0=hk,ψk,j=ψ˙k,j1+αk,j,j=1,,rk,\psi_{k,0}=h_k,\qquad \psi_{k,j}=\dot\psi_{k,j-1}+\alpha_{k,j},\quad j=1,\dots,r_k,ψk,0=hk,ψk,j=ψ˙k,j1+αk,j,j=1,,rk,

其中αk,j\alpha_{k,j}αk,jK\mathcal KK类函数。在相对阶假设下,链的最后阶段对控制输入是仿射的。将所有约束堆叠,得到耦合仿射条件

G(x)ub(x).G(x)u\ge -b(x).G(x)ub(x).

对于每个约束kkk和agent iSki\in S_kiSk,系数方向为

Gk,i=Lgiψk,rk1,bk=Lfψk,rk1+αk,rk.G_{k,i}=L_{g_i}\psi_{k,r_k-1},\qquad b_k=L_f\psi_{k,r_k-1}+\alpha_{k,r_k}.Gk,i=Lgiψk,rk1,bk=Lfψk,rk1+αk,rk.

因此瞬时可行集为

F={x:uU, G(x)ub(x)}.\mathcal F=\{x:\exists u\in\mathcal U,\ G(x)u\ge -b(x)\}.F={x:uU, G(x)ub(x)}.

该方法的核心是一个精确标量可行性证书。令νk,i=Gk,i\nu_{k,i}=G_{k,i}^\topνk,i=Gk,i表示约束kkk对agent iii的输入空间方向。对于非负权重λΔ\lambda\in\DeltaλΔ,其中Δ\DeltaΔ是约束上的概率单纯形,定义agent iii的组合方向为

νi(λ)=k:iSkλkνk,i.\nu_i(\lambda)=\sum_{k:i\in S_k}\lambda_k\nu_{k,i}.νi(λ)=k:iSkλkνk,i.

沿该方向可用的最大输入贡献是支撑函数

σUi(ν)=maxuiUiν,ui.\sigma_{\mathcal U_i}(\nu)=\max_{u_i\in\mathcal U_i}\langle \nu,u_i\rangle.σUi(ν)=uiUimaxν,ui.

可行性储备定义为

M(x)=minλΔ[λb(x)+i=1NσUi(νi(λ))].M(x)=\min_{\lambda\in\Delta} \left[ \lambda^\top b(x)+\sum_{i=1}^{N}\sigma_{\mathcal U_i}\bigl(\nu_i(\lambda)\bigr) \right].M(x)=λΔmin[λb(x)+i=1NσUi(νi(λ))].

作者证明该最小化是一个凸规划,且最小值可达,并且安全过滤器在xxx处可行当且仅当

M(x)0.M(x)\ge 0.M(x)0.

该证书分解为由屏障条件施加的需求项λb\lambda^\top bλb和代表可用执行能力的供给项iσUi(νi(λ))\sum_i\sigma_{\mathcal U_i}(\nu_i(\lambda))iσUi(νi(λ))。当对约束的每种加权,供给都能满足需求时,可行性成立。

当输入集可表示为

Ui=oi+Wi,\mathcal U_i=o_i+\mathcal W_i,Ui=oi+Wi,

其中Wi\mathcal W_iWi是对称、凸且紧的,支撑函数分解为一个偏移项和一个中心化供给项。储备变为

M(x)=minλΔ[λb(x)+S(x,λ)],M(x)=\min_{\lambda\in\Delta} \left[ \lambda^\top b'(x)+S(x,\lambda) \right],M(x)=λΔmin[λb(x)+S(x,λ)],

其中

bk=bk+iSkνk,i,oib'_k=b_k+\sum_{i\in S_k}\langle \nu_{k,i},o_i\ranglebk=bk+iSkνk,i,oi

将非对称输入偏移吸收到有效需求中,而

S(x,λ)=iσWi(νi(λ))S(x,\lambda)=\sum_{i}\sigma_{\mathcal W_i}(\nu_i(\lambda))S(x,λ)=iσWi(νi(λ))

是对称执行供给。这种分离贯穿整个框架。作者还表明,除了分配算法未使用的倒数第二个例外情况,系数方向Gk,iG_{k,i}Gk,i退化为LgiLfrk1hkL_{g_i}L_f^{r_k-1}h_kLgiLfrk1hk,且不依赖于K\mathcal KK类调节参数。因此,调节改变的是需求,而非可用的输入供给。

该证书还支持不可行性诊断。定义最小供给为

S(x)=minλΔS(x,λ).S^\star(x)=\min_{\lambda\in\Delta}S(x,\lambda).S(x)=λΔminS(x,λ).

作者证明S(x)=0S^\star(x)=0S(x)=0恰好当存在权重λΔ\lambda^\star\in\DeltaλΔ使得

νi(λ)spanWi\nu_i(\lambda^\star)\perp \operatorname{span}\mathcal W_iνi(λ)spanWi

对每个agent iii成立。若每个Wi\mathcal W_iWi是满维的,这简化为

Aλ=0,A\lambda^\star=0,Aλ=0,

其中Aλ=(νi(λ))iA\lambda=(\nu_i(\lambda))_iAλ=(νi(λ))i。等价地,原点位于约束方向的凸包中。在这种退化条件下,将所有输入集按任意正因子缩放都无法增加供给。若相应的需求为负,则执行器的任何缩放都不能使该状态可行。因此,该方法区分了由执行器几何引起的不可行性与由冲突或过度的屏障需求引起的不可行性。

该证书还给出了边际敏感性结果。当极小值点λ\lambda^\starλ唯一时,

Mρi(x;ρ)=σWi(νi(λ))0.\frac{\partial M}{\partial\rho_i}(x;\rho) = \sigma_{\mathcal W_i}\bigl(\nu_i(\lambda^\star)\bigr)\ge 0.ρiM(x;ρ)=σWi(νi(λ))0.

边际值为零表明增加agent iii的执行权限无法改善可行性。作者还给出了稀疏性结果:存在一个极小值点λ\lambda^\starλ,其支撑集大小至多为

rank[A;1]imi+1.\operatorname{rank}[A;\mathbf 1^\top] \le \sum_i m_i+1.rank[A;1]imi+1.

因此,一个不可约冲突涉及的约束数至多比总执行自由度多一个,使得该界限是维数性的而非组合性的。

对于分散式执行,作者引入责任权重θk,i0\theta_{k,i}\ge 0θk,i0,满足

iSkθk,i=1.\sum_{i\in S_k}\theta_{k,i}=1.iSkθk,i=1.

每个共享约束被分配给影响它的agent。若agent iii满足其分配的局部份额

θk,ibk(x)+Gk,i(x)ui0,kEi,\theta_{k,i}b_k(x)+G_{k,i}(x)u_i\ge 0,\qquad k\in E_i,θk,ibk(x)+Gk,i(x)ui0,kEi,

则对iSki\in S_kiSk求和即可恢复原始HOCBF条件。因此,θ\thetaθ的选择影响局部可行性,但不损害安全性。

对于固定分配,agent iii的局部可行性裕度为

miloc(x;θ)=maxuiUiminkEi(θk,ibk(x)+Gk,i(x)ui).m_i^{\mathrm{loc}}(x;\theta) = \max_{u_i\in\mathcal U_i} \min_{k\in E_i} \left( \theta_{k,i}b_k(x)+G_{k,i}(x)u_i \right).miloc(x;θ)=uiUimaxkEimin(θk,ibk(x)+Gk,i(x)ui).

这正是agent iii利用自身输入集所能达到的最差松弛量。若对每个agent均有miloc(x;θ)0m_i^{\mathrm{loc}}(x;\theta)\ge 0miloc(x;θ)0,则全局可行性储备满足M(x)0M(x)\ge 0M(x)0

作者将θ\thetaθ的选择建模为一个最大化最差局部裕度的优化问题。对于多面体输入集,这变为线性规划

maxt,θ,u t\max_{t,\theta,u}\ tt,θ,umax t

约束为

tθk,ibk+Gk,iui,kE, iSk,t\le \theta_{k,i}b_k+G_{k,i}u_i,\quad k\in E,\ i\in S_k,tθk,ibk+Gk,iui,kE, iSk, iSkθk,i=1,θ0,uiUi.\sum_{i\in S_k}\theta_{k,i}=1,\quad \theta\ge 0,\quad u_i\in\mathcal U_i.iSkθk,i=1,θ0,uiUi.

若最优值满足t0t^\star\ge 0t0,则所得分配使所有局部规划可行,并认证全局可行性。若t<0t^\star<0t<0,则不存在可容许的分配能使所有局部规划可行。M(x)0M(x)\ge 0M(x)0t<0t^\star<0t<0之间的差距刻画了分散化引入的可行性损失。

最终的控制步骤在联合状态上求解上述分配规划,并仅将标量责任权重θ\theta^\starθ广播给各agent。然后每个agent在其自身输入集和关联约束上求解一个小型局部规划。该规划还返回一个候选输入uu^\staru。当t0t^\star\ge 0t0时,丢弃uu^\staru,因为它仅认证可行性,每个agent转而选择满足其分配份额且最接近其标称控制的输入。当t<0t^\star<0t<0时,uu^\staru被用作最小不可行动作,使最差局部裕度尽可能高。对于非多面体输入集,同样的构造产生一个凸规划而非线性规划。

实验

评估采用欠驱动平面车辆的闭环仿真,随机起始和目标位置产生密集冲突,同时测试冲突定位和责任分配。对偶乘子在94%的情况下正确识别导致不可行的单一交互,所提出的分配重新分配责任以解决局部规划不可行问题,将不可行控制步数从均匀和按能力加权启发式算法的约50%降至约6%,几乎与集中式过滤器相当。闭环结果表明,这种证书最优分配显著提高了安全性,约束违反更少,平均最近接近距离为正,而按能力加权相比均匀分配几乎没有收益。

证书最优分配的不可行步率接近6%,与集中式参考紧密匹配,而均匀和按能力加权启发式算法导致约一半的控制步不可行。启发式算法的失败率随agent数量急剧增长,而所提方法始终保持较低水平。按能力加权相比均匀分配几乎没有改善。证书最优分配的不可行步率约为6%,几乎与集中式参考相同,而启发式算法约为50%。在均匀和按能力加权分配下,不可行率从N=6时的约27%增加到N=12时的约69%,且按能力加权相比均匀分配改善甚微。

证书最优分配的不可行步率约为6%,几乎与集中式参考相同,而均匀和按能力加权启发式算法导致约一半的控制步不可行。启发式算法的失败率随agent数量急剧上升,而所提方法始终保持较低水平,按能力加权相比均匀分配几乎没有收益。


用 AI 构建 AI

从创意到上线——通过免费 AI 协同编码、开箱即用的环境和最优惠的 GPU 价格,加速您的 AI 开发。

AI 协同编码
开箱即用的 GPU
最优定价

HyperAI Newsletters

订阅我们的最新资讯
我们会在北京时间 每周一的上午九点 向您的邮箱投递本周内的最新更新
邮件发送服务由 MailChimp 提供