HyperAIHyperAI

Command Palette

Search for a command to run...

로보틱스

다중 로봇 CBF 안전 필터를 위한 정확한 실행 가능성 인증 및 최적 책임 할당

Chandan Kumar Sah Jishnu Keshavan

초록

다중 로봇 제어 장벽 함수(CBF) 안전 필터는 실행 불가능해질 수 있지만, 실패한 이차 계획법(QP)만으로는 충돌이 발생한 이유나 해결 방법을 알 수 없다. 이 문제를 해결하기 위해, 우리는 이종 제어 아핀 동역학과 볼록 입력 집합을 갖는 다중 에이전트 CBF 필터를 위한 정확한 실행 가능성 인증서를 개발한다. 이 인증서는 안전 제약 조건이 부과하는 요구량과 사용 가능한 작동기 공급량을 분리하여 실행 가능성 여유를 정량화한다. 이러한 분해는 CBF 이득 조정이나 작동력 증가가 실행 불가능성을 해결할 수 있는 경우와 그렇지 않은 경우를 보여주며, 충돌에 책임이 있는 에이전트와 상호 작용을 식별한다. 나아가 우리는 최악의 국소 실행 가능성 마진을 최대화하여 공유 안전 제약 조건을 최적으로 할당하는 알고리즘을 제안하며, 이는 다면체 입력 집합에 대해 선형 계획법 문제를 도출한다. 320회의 쌍대 폐루프 시뮬레이션에서, 제안된 할당 방식은 실행 불가능한 제어 단계를 약 50%에서 6.2%로 감소시키고, 안전 위반 실행 횟수를 160회 중 118회에서 160회 중 24회로 줄였다. 또한, 52건의 실행 불가능 이벤트 전반에 걸쳐, 인증서가 식별한 상호 작용을 완화했을 때 94%의 경우에서 실행 가능성이 회복되었다.

One-sentence Summary

The authors introduce an exact feasibility certificate for multi-robot CBF safety filters that separates safety demand from actuator supply to quantify a feasibility reserve, along with an optimal allocation algorithm that maximizes the worst local feasibility margin, reducing infeasible control steps from roughly 50% to 6.2% and safety-violating runs from 118/160 to 24/160, while the certificate identifies an interaction whose relaxation restores feasibility in 94% of infeasibility events.

Key Contributions

  • An exact conic feasibility certificate for multi-robot CBF filters is derived that decomposes pointwise feasibility into a constraint demand term and an actuator supply term, applicable to heterogeneous control-affine dynamics and convex input sets.
  • The certificate characterizes when CBF gain tuning or increased actuation can resolve infeasibility, identifies the specific agents and interactions responsible for a conflict via dual variables, and quantifies the marginal value of additional actuation.
  • A certificate-based responsibility allocation is proposed that maximizes the worst local feasibility margin; for polyhedral input sets it reduces to a linear program, and in closed-loop simulations it cuts infeasible control steps from roughly 50% to 6.2% and safety-violating runs from 118/160 to 24/160.

Introduction

Control barrier function (CBF) safety filters offer a principled way to enforce safety without discarding a nominal controller, but in multi-robot systems several pairwise or higher-order constraints often need to hold at once. Even if each constraint is feasible individually, their conjunction can be infeasible, and a standard quadratic program returns only a binary infeasibility flag with no diagnosis of which interaction caused the conflict or how to resolve it. Prior work includes feasibility-guaranteeing constructions, compatibility conditions, nonsmooth barrier compositions, actuation-aware formulations, and online adaptation; the closest methods give feasibility tests for stacked constant-norm linear time-invariant barrier constraints or opposing higher-order CBF bounds for one underactuated system, but they do not quantify the gap between constraint demand and actuator supply or cover state-dependent normals, arbitrary convex input sets, and multi-agent settings. The authors derive an exact conic certificate that characterizes pointwise feasibility and separates constraint demand from actuator supply, enabling diagnosis of whether infeasibility should be addressed by CBF encoding, added actuation, or redistribution of constraint responsibility; the certificate also yields decentralized responsibility allocation that maximizes the worst local feasibility margin, reducing to a linear program for polyhedral input sets.

Method

The authors develop a certificate-based safety filtering framework for decentralized multi-agent systems with high-order control barrier function constraints. The method separates global feasibility certification from local responsibility allocation, allowing each agent to act locally while guaranteeing that the collection of local actions satisfies all coupled HOCBF constraints.

For a system of NNN agents with heterogeneous control-affine dynamics

x˙i=fi(xi)+gi(xi)ui,ui∈Ui,\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​,ui​∈Ui​,

each safety constraint kkk is represented by a barrier function hkh_khk​ whose support SkS_kSk​ contains the agents that affect it. For constraints with uniform relative degree rkr_krk​, the authors construct a HOCBF chain

ψk,0=hk,ψk,j=ψ˙k,j−1+α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,j−1​+αk,j​,j=1,…,rk​,

where αk,j\alpha_{k,j}αk,j​ are class-K\mathcal KK functions. Under the relative degree assumption, the final stage of the chain is affine in the control inputs. Stacking all constraints gives the coupled affine condition

G(x)u≥−b(x).G(x)u\ge -b(x).G(x)u≥−b(x).

For each constraint kkk and agent i∈Ski\in S_ki∈Sk​, the coefficient direction is

Gk,i=Lgiψk,rk−1,bk=Lfψk,rk−1+α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,rk​−1​,bk​=Lf​ψk,rk​−1​+αk,rk​​.

The instantaneous feasible set is therefore

F={x:∃u∈U, G(x)u≥−b(x)}.\mathcal F=\{x:\exists u\in\mathcal U,\ G(x)u\ge -b(x)\}.F={x:∃u∈U, G(x)u≥−b(x)}.

A central component of the method is an exact scalar feasibility certificate. Let νk,i=Gk,i⊤\nu_{k,i}=G_{k,i}^\topνk,i​=Gk,i⊤​ denote the input-space direction associated with constraint kkk for agent iii. For a nonnegative weighting λ∈Δ\lambda\in\Deltaλ∈Δ, where Δ\DeltaΔ is the probability simplex over the constraints, define the combined direction for agent iii as

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

The maximum input contribution available along this direction is the support function

σUi(ν)=max⁡ui∈Ui⟨ν,ui⟩.\sigma_{\mathcal U_i}(\nu)=\max_{u_i\in\mathcal U_i}\langle \nu,u_i\rangle.σUi​​(ν)=ui​∈Ui​max​⟨ν,ui​⟩.

The feasibility reserve is defined as

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=1∑N​σUi​​(νi​(λ))].

The authors prove that this minimization is a convex program with an attained minimum and that the safety filter is feasible at xxx if and only if

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

The certificate decomposes into a demand term λ⊤b\lambda^\top bλ⊤b, imposed by the barrier conditions, and a supply term ∑iσUi(νi(λ))\sum_i\sigma_{\mathcal U_i}(\nu_i(\lambda))∑i​σUi​​(νi​(λ)), representing the available actuation capability. Feasibility holds when supply meets demand for every weighting of the constraints.

When the input sets can be expressed as

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

with Wi\mathcal W_iWi​ symmetric, convex, and compact, the support function decomposes into an offset term and a centered supply term. The reserve becomes

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,λ)],

where

bk′=bk+∑i∈Sk⟨νk,i,oi⟩b'_k=b_k+\sum_{i\in S_k}\langle \nu_{k,i},o_i\ranglebk′​=bk​+i∈Sk​∑​⟨νk,i​,oi​⟩

absorbs asymmetric input offsets into the effective demand, and

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

is the symmetric actuation supply. This separation is used throughout the framework. The authors also show that, apart from a penultimate exception not used by the allocation algorithm, the coefficient direction Gk,iG_{k,i}Gk,i​ reduces to LgiLfrk−1hkL_{g_i}L_f^{r_k-1}h_kLgi​​Lfrk​−1​hk​ and does not depend on the class-K\mathcal KK tuning parameters. Thus tuning changes the demand but not the available input supply.

The certificate also supports diagnosis of infeasibility. Define the minimum supply as

S⋆(x)=min⁡λ∈ΔS(x,λ).S^\star(x)=\min_{\lambda\in\Delta}S(x,\lambda).S⋆(x)=λ∈Δmin​S(x,λ).

The authors show that S⋆(x)=0S^\star(x)=0S⋆(x)=0 exactly when there exists a weighting λ⋆∈Δ\lambda^\star\in\Deltaλ⋆∈Δ such that

νi(λ⋆)⊥span⁡Wi\nu_i(\lambda^\star)\perp \operatorname{span}\mathcal W_iνi​(λ⋆)⊥spanWi​

for every agent iii. If every Wi\mathcal W_iWi​ is full-dimensional, this reduces to

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

where Aλ=(νi(λ))iA\lambda=(\nu_i(\lambda))_iAλ=(νi​(λ))i​. Equivalently, the origin lies in the convex hull of the constraint directions. Under this degeneracy condition, scaling all input sets by any positive factor cannot increase the supply. If the corresponding demand is negative, no scaling of the actuators can render the state feasible. The method therefore distinguishes infeasibility caused by actuator geometry from infeasibility caused by conflicting or excessive barrier demand.

The certificate additionally yields a marginal sensitivity result. When the minimizer λ⋆\lambda^\starλ⋆ is unique,

∂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.∂ρi​∂M​(x;ρ)=σWi​​(νi​(λ⋆))≥0.

A zero marginal value indicates that increasing the actuation authority of agent iii cannot improve feasibility. The authors also give a sparsity result: there exists a minimizer λ⋆\lambda^\starλ⋆ whose support size is at most

rank⁡[A;1⊤]≤∑imi+1.\operatorname{rank}[A;\mathbf 1^\top] \le \sum_i m_i+1.rank[A;1⊤]≤i∑​mi​+1.

Thus an irreducible conflict involves at most one more constraint than the total actuated degrees of freedom, making the bound dimensional rather than combinatorial.

For decentralized execution, the authors introduce responsibility weights θk,i≥0\theta_{k,i}\ge 0θk,i​≥0 satisfying

∑i∈Skθk,i=1.\sum_{i\in S_k}\theta_{k,i}=1.i∈Sk​∑​θk,i​=1.

Each shared constraint is divided among the agents that affect it. If agent iii satisfies its assigned local share

θk,ibk(x)+Gk,i(x)ui≥0,k∈Ei,\theta_{k,i}b_k(x)+G_{k,i}(x)u_i\ge 0,\qquad k\in E_i,θk,i​bk​(x)+Gk,i​(x)ui​≥0,k∈Ei​,

then summing over i∈Ski\in S_ki∈Sk​ recovers the original HOCBF condition. Therefore, the choice of θ\thetaθ affects local feasibility but does not compromise safety.

For a fixed allocation, the local feasibility margin of agent iii is

miloc(x;θ)=max⁡ui∈Uimin⁡k∈Ei(θ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;θ)=ui​∈Ui​max​k∈Ei​min​(θk,i​bk​(x)+Gk,i​(x)ui​).

This is exactly the worst-case slack that agent iii can achieve with its own input set. If miloc(x;θ)≥0m_i^{\mathrm{loc}}(x;\theta)\ge 0miloc​(x;θ)≥0 for every agent, then the global feasibility reserve satisfies M(x)≥0M(x)\ge 0M(x)≥0.

The authors cast the selection of θ\thetaθ as an optimization problem that maximizes the worst local margin. For polytopic input sets, this becomes the linear program

max⁡t,θ,u t\max_{t,\theta,u}\ tt,θ,umax​ t

subject to

t≤θk,ibk+Gk,iui,k∈E, i∈Sk,t\le \theta_{k,i}b_k+G_{k,i}u_i,\quad k\in E,\ i\in S_k,t≤θk,i​bk​+Gk,i​ui​,k∈E, i∈Sk​, ∑i∈Skθk,i=1,θ≥0,ui∈Ui.\sum_{i\in S_k}\theta_{k,i}=1,\quad \theta\ge 0,\quad u_i\in\mathcal U_i.i∈Sk​∑​θk,i​=1,θ≥0,ui​∈Ui​.

If the optimal value satisfies t⋆≥0t^\star\ge 0t⋆≥0, the resulting allocation makes all local programs feasible and certifies global feasibility. If t⋆<0t^\star<0t⋆<0, no admissible allocation can make all local programs feasible. The gap between M(x)≥0M(x)\ge 0M(x)≥0 and t⋆<0t^\star<0t⋆<0 characterizes the feasibility loss introduced by decentralization.

The resulting control step solves the above allocation program on the joint state and broadcasts only the scalar responsibility weights θ⋆\theta^\starθ⋆ to the agents. Each agent then solves a small local program over its own input set and incident constraints. The program also returns a candidate input u⋆u^\staru⋆. When t⋆≥0t^\star\ge 0t⋆≥0, u⋆u^\staru⋆ is discarded because it only certifies feasibility, and each agent instead selects the input closest to its nominal control that satisfies its assigned share. When t⋆<0t^\star<0t⋆<0, u⋆u^\staru⋆ is used as the least infeasible action, keeping the worst local margin as high as possible. For non-polytopic input sets, the same construction yields a convex program instead of a linear program.

Experiment

The evaluation uses closed-loop simulations of underactuated planar vehicles with random start and goal positions that create dense conflicts, testing both conflict localization and responsibility allocation. The dual multiplier correctly identifies the single interaction causing infeasibility in 94% of cases, and the proposed allocation redistributes responsibility to resolve local program infeasibility, reducing infeasible control steps from roughly 50% for uniform and capability-weighted heuristics to about 6%, nearly matching a centralized filter. Closed-loop results show that this certificate-optimal allocation substantially improves safety, with fewer constraint violations and a positive mean closest approach, while capability weighting provides negligible benefit over uniform allocation.

The certificate-optimal allocation achieves infeasible-step rates near 6%, closely matching the centralized reference, while uniform and capability-weighted heuristics cause infeasibility in roughly half of all control steps. The heuristics’ failure rate grows steeply with the number of agents, whereas the proposed method remains consistently low. Capability weighting provides almost no benefit over uniform allocation. The certificate-optimal allocation yields infeasible-step rates around 6%, nearly identical to the centralized reference, compared to roughly 50% for the heuristics. Under uniform and capability-weighted allocations, infeasibility increases from ~27% at N=6 to ~69% at N=12, and capability weighting offers negligible improvement over uniform allocation.

The certificate-optimal allocation achieves infeasible-step rates around 6%, nearly matching the centralized reference, while uniform and capability-weighted heuristics cause infeasibility in roughly half of all control steps. The heuristics' failure rate rises sharply with the number of agents, whereas the proposed method remains consistently low, and capability weighting provides almost no benefit over uniform allocation.


AI로 AI 구축

아이디어에서 출시까지 — 무료 AI 코코딩, 즉시 사용 가능한 환경, 최적의 GPU 가격으로 AI 개발을 가속화하세요.

AI 협업 코딩
바로 사용 가능한 GPU
최적의 가격

HyperAI Newsletters

최신 정보 구독하기
한국 시간 매주 월요일 오전 9시 에 이번 주의 최신 업데이트를 메일로 발송합니다
이메일 서비스 제공: MailChimp