Time-Optimal Switching Surfaces for Triple Integrator under Full Box Constraints

Technische Samenvatting: Tijd-optimale schakeloppervlakken voor een triple integrator onder volledige box-beperkingen

Probleemstelling
Dit artikel behandelt het tijd-optimale regelprobleem voor een triple integrator-systeem dat onderhevig is aan volledige box-beperkingen. De systeemdynamiek omvatten stuurbewegingen met beperkte versnellingsverandering (jerk-beperkte stuurbewegingen $u$) en toestandsbeperkingen voor positie ($x_1$), snelheid ($x_2$) en versnelling ($x_3$). Het doel is om het systeem in minimale tijd $t_f$ over te brengen van een willekeurige beginstaat $\mathbf{x}_0$ naar een vaste eindstaat $\mathbf{x}_f$.

Hoewel tijd-optimale regeling voor dubbele integratoren goed begrepen is, vormt het geval van de triple integrator aanzienlijke uitdagingen, met name bij het omgaan met:

1. Asymmetrische beperkingen: Waarboven- en ondergrenzen voor jerk en toestanden niet gelijk zijn in grootte.
2. Niet-stationaire randvoorwaarden: Willekeurige begin- en eindtoestanden.
3. Actieve positiebeperkingen: Scenario's waarbij de trajecten de grenzen van de positiebeperkingen moeten raken of langs deze moeten glijden ($x_3 = \bar{x}_3$ of $x_3 = \underline{x}_3$).

Bestaande oplossingen, zoals het commerciële Ruckig-algoritme (community-versie), falen vaak onder asymmetrische beperkingen of actieve positiebeperkingen. Eerdere analytische benaderingen hebben ofwel toestandsbeperkingen genegeerd, symmetrische beperkingen verondersteld, of geen volledige karakterisering geboden van de schakeloppervlakken en de actieve voorwaarden voor positiebeperkingen.

Methodologie
De auteurs maken gebruik van het Maximum-principe van Pontryagin (PMP) om de optimale regelwet te karakteriseren, die een Bang-Bang-Singulier (BBS) structuur volgt. De kern van de methodologie bestaat uit een geometrische analyse van de toestandsruimte om tijd-optimale schakeloppervlakken af te leiden.

1. Augmented Switching Law (ASL): De optimale trajecten worden weergegeven als een reeks bogen (onbeperkte bang-bang-bogen en beperkte bogen waarbij toestanden vastliggen) en "tangent markers". Een tangent marker treedt op wanneer de positiebeperking raakend actief wordt (d.w.z. $x_3 = \bar{x}_3$, $x_2 = 0$, en $x_1 \geq 0$).
2. Constructie van Schakeloppervlakken:
   • Zonder Positiebeperkingen: De auteurs construeren schakelvariëteiten door achterwaartse integratie vanaf de eindstaat $\mathbf{x}_f$. Ze definiëren oppervlakken die corresponderen met specifieke ASL's (bijv. $\bar{0}\bar{0}\bar{0}$, $\bar{0}\bar{1}\bar{0}\bar{0}$) die de 3D-toestandsruimte partitioneren.
   • Met Positiebeperkingen: Het artikel leidt de specifieke voorwaarden af waaronder positiebeperkingen actief worden. Het introduceert nieuwe schakeloppervlakken (bijv. $\bar{0}(\bar{3}, 2)\bar{0}\bar{0}\bar{0}$) die rekening houden met trajecten die raakend zijn aan de positiegrens. Stelling 2 biedt een complete classificatie van alle mogelijke ASL-vormen voor de triple integrator met volledige box-beperkingen, waarbij wordt vastgesteld dat optimale trajecten bestaan uit reeksen van onbeperkte bogen en tangent markers.
3. Algoritmische Implementatie:
   • Algoritme 1: Bepaalt de relatieve richting tussen $\mathbf{x}_0$ en $\mathbf{x}_f$ door analyse van projecties van de 2e orde, en behandelt gevallen waarbij schakeloppervlakken meerwaardig zijn.
   • Algoritme 2: Lost het probleem op zonder positiebeperkingen door toestanden te verbinden via optimale regelingen van de 2e orde en polynoomvergelijkingen op te lossen voor booglengtes.
   • Algoritme 3: Breidt de oplossing uit naar volledige box-beperkingen. Als de onbeperkte oplossing positiebeperkingen schendt, verbindt het algoritme recursief de staat met een tangent marker (afgeleid van Stelling 2) en lost de subproblemen op.
   • Het stelsel vergelijkingen voor booglengtes wordt opgelost met behulp van Gröbner-bases, waarbij het probleem wordt gereduceerd tot één polynoomvergelijking van graad $\leq 6$.

Belangrijkste Bijdragen

• Complete Karakterisering van Schakeloppervlakken: Voor het eerst biedt het artikel een complete analytische karakterisering van tijd-optimale schakeloppervlakken voor de triple integrator onder volledige box-beperkingen, inclusief de geometrische structuur van oplossingen met actieve positiebeperkingen.
• Afleiding van Actieve Voorwaarden: Het artikel leidt expliciet de voorwaarden af waaronder positiebeperkingen actief worden (de "tangent marker"-voorwaarde), een gat dat eerder ontbrak in de literatuur.
• Stelling 2 (ASL-classificatie): Het vestigt de complete set van toelaatbare Augmented Switching Laws voor dit probleem, bewijzend dat optimale trajecten specifieke reeksen volgen die tangent markers bevatten.
• Efficiënt Algoritme: Er wordt een algoritme voorgesteld dat tijd-optimale trajecten plant voor willekeurige randtoestanden en asymmetrische beperkingen.

Resultaten
De voorgestelde methode werd geëvalueerd tegen drie baselines: Ruckig (community-versie), CasADi (gebaseerd op IPOPT) en SCP (Sequential Convex Programming).

• Succespercentage: De voorgestelde methode behaalde een succespercentage van 100% bij het vinden van haalbare oplossingen voor zowel symmetrische (Geval 1) als asymmetrische beperkingen met actieve positiebeperkingen (Geval 2). Daarentegen faalde Ruckig in Geval 2 vanwege asymmetrie, en SCP/CasADi vertoonden aanzienlijk lagere succespercentages (respectievelijk 34,1% en 97,7% in Geval 2).
• Berekeningsefficiëntie: De gemiddelde rekentijd per traject bedroeg ongeveer 10 $\mu$s (specifiek $2,38 \times 10^{-6}$ s voor Geval 1 en $1,25 \times 10^{-5}$ s voor Geval 2). Dit vertegenwoordigt een reductie van 5 ordes van grootte ten opzichte van op optimalisatie gebaseerde baselines (CasADi: ~0,28 s; SCP: ~7,28 s).
• Optimaliteit: De methode vond consequent globaal optimale oplossingen. In testgevallen waar op optimalisatie gebaseerde methoden convergeerden naar lokale optima (suboptimale ASL's), reduceerde de voorgestelde methode de eindtijd met maximaal 90,9% (Geval 1) en 73,4% (Geval 2).

Beteekenis
De auteurs stellen dat dit werk de eerste complete karakterisering van schakeloppervlakken en een efficiënt algoritme biedt voor het tijd-optimale regelprobleem van de 3e orde onder niet-stationaire eindvoorwaarden en actieve positiebeperkingen. Door weg te bewegen van iteratieve optimalisatie naar een geometrische, analytische oplossing, toont het artikel aan dat hoog-precisie, tijd-optimale regeling kan worden bereikt met rekentijden op microseconde-niveau, wat het zeer geschikt maakt voor real-time industriële toepassingen zoals robotbeweging en numeriek gestuurde bewerkingsmachines waar beperkingen vaak asymmetrisch en actief zijn.