HyperAIHyperAI

Command Palette

Search for a command to run...

Robotique

Certification exacte de la faisabilité et allocation optimale des responsabilités pour les filtres de sécurité CBF multi-robots

Chandan Kumar Sah Jishnu Keshavan

Résumé

Les filtres de sécurité basés sur les fonctions de barrière de contrôle (CBF) pour systèmes multi-robots peuvent devenir infaisables, mais l'échec d'un programme quadratique (QP) n'indique ni la cause du conflit ni la manière de le résoudre. Pour répondre à ce problème, nous développons un certificat de faisabilité exact pour les filtres CBF multi-agents avec des dynamiques affines en la commande hétérogènes et des ensembles d'entrée convexes. Le certificat quantifie une réserve de faisabilité en séparant la demande imposée par les contraintes de sécurité de l'offre disponible des actionneurs. Cette décomposition montre quand le réglage du gain des CBF ou l'augmentation de l'actionnement peut, ou ne peut pas, résoudre l'infaisabilité, et identifie les agents et les interactions responsables d'un conflit. Nous proposons en outre un algorithme pour allouer de manière optimale les contraintes de sécurité partagées en maximisant la pire marge de faisabilité locale, ce qui donne un programme linéaire pour les ensembles d'entrée polyédriques. Sur 320 simulations en boucle fermée appariées, l'allocation proposée réduit les pas de commande infaisables d'environ 50 % à 6,2 %, et fait passer les exécutions avec violation de sécurité de 118/160 à 24/160. De plus, sur 52 événements d'infaisabilité, le certificat identifie une interaction dont le relâchement rétablit la faisabilité dans 94 % des cas.

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,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,

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,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,

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)ub(x).G(x)u\ge -b(x).G(x)ub(x).

For each constraint kkk and agent iSki\in S_kiSk, the coefficient direction is

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.

The instantaneous feasible set is therefore

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)}.

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:iSkλkνk,i.\nu_i(\lambda)=\sum_{k:i\in S_k}\lambda_k\nu_{k,i}.νi(λ)=k:iSkλkνk,i.

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

σUi(ν)=maxuiUiν,ui.\sigma_{\mathcal U_i}(\nu)=\max_{u_i\in\mathcal U_i}\langle \nu,u_i\rangle.σUi(ν)=uiUimaxν,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=1Nσ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+iSkνk,i,oib'_k=b_k+\sum_{i\in S_k}\langle \nu_{k,i},o_i\ranglebk=bk+iSkν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 LgiLfrk1hkL_{g_i}L_f^{r_k-1}h_kLgiLfrk1hk 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)=λΔminS(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(λ)spanWi\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.ρiM(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]imi+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,i0\theta_{k,i}\ge 0θk,i0 satisfying

iSkθk,i=1.\sum_{i\in S_k}\theta_{k,i}=1.iSkθ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)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,

then summing over iSki\in S_kiSk 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;θ)=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).

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

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

subject to

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.

If the optimal value satisfies t0t^\star\ge 0t0, 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 uu^\staru. When t0t^\star\ge 0t0, uu^\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, uu^\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.


Créer de l'IA avec l'IA

De l'idée au lancement — accélérez votre développement IA avec le co-codage IA gratuit, un environnement prêt à l'emploi et le meilleur prix pour les GPU.

Codage assisté par IA
GPU prêts à l’emploi
Tarifs les plus avantageux

HyperAI Newsletters

Abonnez-vous à nos dernières mises à jour
Nous vous enverrons les dernières mises à jour de la semaine dans votre boîte de réception à neuf heures chaque lundi matin
Propulsé par MailChimp