A Class of Axis-Angle Attitude Control Laws for Rotational Systems

Probleemstelling

De stabilisatie en besturing van rotatiesystemen (zoals drones, satellieten en robots) wordt traditioneel aangepakt met drie benaderingen: quaternions, Euler-hoeken en rotatiematrices (geometrische controle).

• Beperkingen van bestaande methoden: Hoewel quaternion-gebaseerde methoden populair zijn vanwege hun robuustheid, vertonen ze een tegenintuïtief gedrag in de proportionele regeling. Bij grote rotatiefouten (groter dan $\pi$ rad) neemt de regelingkracht af naarmate de fout toeneemt. Dit komt doordat de standaardformulering de fout as $\sin(\Theta_e/2)$ schaalt, wat een minimum bereikt bij de onstabiele evenwichtspunten (waar de fout $2\pi$ is).
• Topologische obstructie: Het is bekend dat globale asymptotische stabiliteit op de speciale orthogonale groep $SO(3)$ niet kan worden bereikt met continue, tijd-invariante feedback. Bestaande oplossingen gebruiken vaak discontinuïteiten of hybride schakelschema's om dit te omzeilen, maar dit kan complexiteit en ongewenst gedrag (zoals "unwinding" of onnodige volledige rotaties) introduceren.
• Behoefte: Er is behoefte aan een controlewet die meer flexibiliteit biedt in het ontwerp van de regeling, waarbij de regelingkracht toeneemt naarmate de systeemtoestand verder van het stabiele punt verwijderd is, en die compatibel is met intelligente schakelstrategieën die rekening houden met hoeksnelheid.

Methodologie

De auteurs introduceren een nieuwe klasse van attitude-controlewetten gebaseerd op een gegeneraliseerde as-hoek (axis-angle) representatie.

1. Gegeneraliseerde Foutrepresentatie:
   In plaats van de standaard quaternion-fout te gebruiken, definiëren de auteurs een "Scaled Euler Axis" (SEA), $\boldsymbol{\alpha}_e = \gamma(\Theta_e)\mathbf{u}_e$. Hierbij is $\Theta_e$ de rotatiefout en $\mathbf{u}_e$ de as van rotatie. De functie $\gamma(\Theta_e)$ is een extended class K-functie (een strikt stijgende functie met $\gamma(0)=0$).

   • Dit zorgt ervoor dat de regelingsterkte monotoon toeneemt met de grootte van de fout binnen het interval $\Theta_e \in [0, 2\pi)$.

2. Controlewet Ontwerp:
   De voorgestelde controlewet ($\boldsymbol{\tau}_\gamma$) bevat een proportionele term die direct gekoppeld is aan deze SEA, in plaats van aan de standaard quaternion-componenten. De wet wordt afgeleid via Lyapunov-stabiliteitstheorie.

   • De auteurs bewijzen dat door $\gamma$ als een extended class K-functie te kiezen, er een uniek evenwichtspunt ontstaat voor de gesloten-lus dynamiek, zelfs binnen een continue formulering.
   • Dit omzeilt de topologische obstructie van $SO(3)$ door de dynamica te definiëren op een overdekking (covering) die een unieke coördinatenrepresentatie voor elke rotatie genereert.

3. Stabiliteitsanalyse:
   Er wordt een Lyapunov-functie geconstrueerd die positief definiet is. Onder specifieke voorwaarden voor de regelaarwinsten ($k_\alpha, k_\delta, k_\omega$), wordt aangetoond dat de tijdsafgeleide van de Lyapunov-functie negatief definiet is. Dit garandeert globale asymptotische stabiliteit van het evenwichtspunt.

4. Implementatie:
   De methode is getest in combinatie met een "Model Predictive Selection" (MPS) algoritme. Dit algoritme kiest dynamisch de richting van de regeling (de kortste of langste rotatiepad) op basis van de huidige hoeksnelheid en de te verwachten kosten, wat de efficiëntie van de manoeuvre verbetert.

Kernbijdragen

• Nieuwe Klasse Controlewetten: Een generalisatie van de as-hoek representatie die de beperkingen van quaternion-gebaseerde proportionele regelingen opheft.
• Ontwerpflexibiliteit: De gebruiker kan de vorm van de functie $\gamma(\Theta_e)$ (bijvoorbeeld een sigmoid-functie) kiezen om de regeling te tunen voor specifieke platformeigenschappen (zoals actuatorlimieten), zonder stabiliteit te verliezen.
• Gedrag bij Grote Fouten: In tegenstelling tot traditionele methoden, zorgt deze methode ervoor dat de regelingsterkte toeneemt naarmate de rotatiefout groter is (tot $2\pi$), wat essentieel is voor snelle herstelmanoeuvres.
• Uniek Evenwicht: Bewijs van het bestaan van een uniek stabiel evenwichtspunt zonder de noodzaak van complexe discontinuïteiten in de basisformulering.

Resultaten

De auteurs hebben de methode gevalideerd via uitgebreide simulaties en echte vluchttesten met een Crazyflie 2.1 drone.

• Simulaties:

  • Er werden 10.908 simulaties uitgevoerd van "tumble-recovery" manoeuvres (herstel van een draaiende val) met willekeurige initiële hoeken en hoeksnelheden.
  • De nieuwe methode ($\tilde{\boldsymbol{\tau}}_\gamma$) presteerde consistent beter dan een quaternion-benchmarks ($\tilde{\boldsymbol{\tau}}_b$) en een geometrische benchmark ($\boldsymbol{\tau}_g$).
  • Stabilisatietijd: De nieuwe methode bereikte kortere stabilisatietijden, vooral bij grote initiële rotatiefouten.
  • Regelinspanning: De nieuwe methode vereiste aanzienlijk minder controle-energie (gemeten als integraal van het koppel) om de drone te stabiliseren.

• Experimentele Vluchttesten:

  • De drone werd handmatig in de lucht gegooid met hoge hoeksnelheid en moest zichzelf autonoom stabiliseren.
  • Resultaten: De nieuwe methode bereikte een gemiddelde stabilisatietijd van 0,55 s, vergeleken met 0,74 s (quaternion) en 0,61 s (geometrisch).
  • Efficiëntie: De regelinspanning voor de nieuwe methode was ongeveer 25% lager dan die van de geometrische methode, terwijl de stabilisatie sneller ging.
  • De data toonde aan dat de SEA-norm ($\|\boldsymbol{\alpha}_e\|$) correct gedrag vertoonde (toenemend met de fout), terwijl de quaternion-norm ($\|\mathbf{n}_e\|$) het bekende tegenintuïtieve gedrag vertoonde (afnemend bij grote fouten).

Significantie

Dit werk biedt een fundamentele verbetering in de attitude-controletheorie voor rotatiesystemen. De belangrijkste implicaties zijn:

1. Betere prestaties bij extreme condities: De methode is bij uitstek geschikt voor situaties waarbij systemen grote hoekfouten en hoge hoeksnelheden hebben (zoals het herstel van een drone na een val of crash).
2. Energie-efficiëntie: Door minder regelingkracht te gebruiken voor dezelfde stabilisatieprestaties, wordt de batterijduur van autonome systemen verlengd.
3. Ontwerpruimte: Het biedt controleurs meer vrijheid om de regelaar te vormen voor specifieke toepassingen, terwijl de wiskundige stabiliteitsgaranties behouden blijven.
4. Praktische toepasbaarheid: De succesvolle vluchttesten bewijzen dat de theorie direct toepasbaar is op realistische, niet-ideale systemen met ruis, modelonzekerheid en actuatorbeperkingen.

Kortom, deze paper introduceert een robuustere en efficiëntere manier om rotatiesystemen te stabiliseren door de fundamentele wiskundige representatie van de fout te herdefiniëren, wat leidt tot superieure prestaties in kritieke scenario's.