Task-Space Singularity Avoidance for Control Affine Systems Using Control Barrier Functions

Titel: Taakruimte-Singulariteitsvermijding voor Control-Affiene Systemen met Behulp van Control Barrier Functions

1. Probleemdefinitie

In veel dynamische systemen, met name in de robotica en veiligheidskritische toepassingen, is het essentieel dat het systeem in staat is om de benodigde krachten en momenten te genereren om gewenste trajecten te volgen. Een fundamentele uitdaging is het optreden van kinematische singulariteiten.

• Oorzaak: Singulariteiten treden op wanneer de afbeelding van besturingselementen (inputs) naar beweging in de taakruimte (task-space) zijn rang verliest (rank-deficient). Dit gebeurt wanneer de Jacobiaan of de besturingsmatrix slecht geconditioneerd wordt.
• Gevolgen:
  • Het systeem kan niet langer krachten in de gewenste richtingen genereren.
  • De mogelijkheid om willekeurige trajecten binnen de werkruimte te volgen, gaat verloren.
  • Controllers die afhankelijk zijn van matrixinversie (zoals pseudoinverses) genereren vaak enorme, abrupte besturingspieken ("spikes") nabij singulariteiten. Dit leidt tot instabiliteit, verminderde prestaties en veiligheidsrisico's.
• Huidige beperkingen: Bestaande methoden (zoals hybride schakeling, hardware-herontwerp of regularisatie) missen vaak formele veiligheidsgaranties of zijn moeilijk te generaliseren.

2. Methodologie

De auteurs presenteren een raamwerk gebaseerd op Control Barrier Functions (CBF) om singulariteiten in real-time te vermijden voor control-affiene systemen ($\dot{x} = f(x) + g(x)u$).

A. Identificatie van Singulariteiten

• Singulariteiten worden geïdentificeerd via de eigenwaarden van een toestandsafhankelijke input-output afbeeldingsmatrix $\phi(x) = J(x)g(x)$.
• Een configuratie is singulier wanneer $\phi(x)$ rangverlies ondergaat, wat betekent dat een of meer singuliere waarden naar nul naderen.
• Om dit te analyseren, wordt de matrix $M(x) = \phi(x)\phi(x)^T$ (voor over-geactiveerde systemen) of $M(x) = \phi(x)^T\phi(x)$ gebruikt. De eigenwaarden van $M(x)$ corresponderen met de kwadraten van de singuliere waarden van $\phi(x)$.

B. Constructie van de Control Barrier Function (CBF)

• Een veilige set $C$ wordt gedefinieerd als $h(x) \geq 0$.
• De auteurs definiëren de CBF $h_i(x)$ voor elke relevante eigenwaarde $\lambda_i(x)$ van $M(x)$ als:
  $$h_i(x) = \lambda_i(x) - \epsilon$$
  waarbij $\epsilon > 0$ een kleine veiligheidsmarge is om de singulariteit (waar $\lambda_i = 0$) te vermijden.
• Theoretische garantie: Er wordt bewezen dat als de afgeleide van de CBF langs de trajecten voldoet aan $\dot{h}(x) \geq -\alpha(h(x))$, de veilige set voorwaarts invariant is. Dit garandeert dat de eigenwaarden boven $\epsilon$ blijven, waardoor de matrix $\phi(x)$ volwaardig blijft.

C. Implementatie via Quadratic Programming (QP)

• De besturing wordt berekend door een QP op te lossen die de afwijking van een nominale besturing $v(x)$ minimaliseert, onder de CBF-beperking:
  $$\min_u \frac{1}{2}(u-v(x))^T Q(x) (u-v(x))$$
  $$\text{onder de voorwaarde: } L_f h(x) + L_g h(x) u \geq -\alpha(h(x))$$
• Voor over-geactiveerde systemen (meer actuatoren dan vrijheidsgraden) wordt een regularisatieterm $\Gamma$ toegevoegd aan $Q(x)$ om convexiteit te garanderen.

D. Twee Benaderingen

1. Analytische CBF: Voor eenvoudige systemen (zoals een 2-link manipulator) worden de eigenwaarden en hun afgeleiden analytisch afgeleid.
2. Numerieke CBF: Voor complexe systemen (zoals magnetische actuatoren) waar analytische oplossingen onpraktisch zijn, worden singulariteitsregio's numeriek geïdentificeerd via SVD (Singular Value Decomposition). Deze regio's worden gemodelleerd als virtuele 3D-obstakels (via Alpha Shapes) die als CBF-beperkingen in het QP worden opgenomen.

3. Belangrijkste Resultaten

De methode werd gevalideerd via simulaties op twee systemen:

• Planar 2-link Manipulator:

  • Scenario: De arm werd naar een singuliere configuratie (rechte arm, $q_2 \to 0$) gedreven.
  • Resultaat: Zonder CBF ontstonden er enorme pieken in de hoeksnelheden en abrupte veranderingen in de hoeken. Met de CBF werd de singulariteit succesvol vermeden door de hoek $q_2$ licht te modificeren.
  • Verbetering: De besturingspieken werden met ongeveer 70x tot 100x gereduceerd ten opzichte van de nominale controller, terwijl het traject soepel bleef.

• Magnetisch Geactiveerde Naald (Chirurgische Toepassing):

  • Scenario: Een naald moest een hechtraad (suture) uitvoeren in een werkruimte van 35 mm, waarbij de magnetische actuatoren singulariteiten kunnen vertonen.
  • Resultaat: De CBF-QP paste de oriëntatie van de naald aan om de singuliere regio's te vermijden, zonder de gewenste ruimtelijke baan te missen.
  • Prestaties: De RMS-posatiefout was 0,99 mm en de RMS-oriëntatiefout 0,65 rad. De naald bleef tijdens de hele operatie buiten de singuliere set (groen gemarkeerd in configuratieruimte).

4. Bijdragen en Significantie

• Formele Veiligheidsgaranties: Het artikel biedt een wiskundig onderbouwd raamwerk dat garandeert dat systemen singuliere configuraties niet binnengaan, wat cruciaal is voor veiligheidskritische toepassingen.
• Generaliseerbaarheid: Het raamwerk is toepasbaar op onder-geactiveerde, volledig geactiveerde en over-geactiveerde systemen, ongeacht de gekozen referentiecontroller.
• Flexibiliteit: Door zowel analytische als numerieke (obstakel-gebaseerde) methoden te bieden, kan de methode worden toegepast op systemen van variërende complexiteit.
• Praktische Impact: De significante reductie van besturingspieken (tot 100x) betekent minder slijtage aan hardware, minder energieverbruik en een hogere stabiliteit, wat direct toepasbaar is in robotchirurgie en precisierobotica.

Conclusie:
De auteurs hebben een effectieve CBF-gebaseerde strategie ontwikkeld die singulariteiten in real-time detecteert en vermijdt door de besturing minimaal aan te passen. Dit resulteert in soepelere, veiligere en stabielere bewegingen voor dynamische systemen, zelfs in de buurt van kritieke configuraties.