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

Sintesi Tecnica: Superfici di Commutazione Ottimali nel Tempo per un Triplo Integratore sotto Vincoli a Scatola Completi

Enunciato del Problema
Questo articolo affronta il problema del controllo ottimo nel tempo per un sistema a triplo integratore soggetto a vincoli a scatola completi. Le dinamiche del sistema coinvolgono ingressi di controllo a jerk limitato ($u$) e vincoli di stato su posizione ($x_1$), velocità ($x_2$) e accelerazione ($x_3$). L'obiettivo è trasferire il sistema da uno stato iniziale arbitrario $\mathbf{x}_0$ a uno stato terminale fisso $\mathbf{x}_f$ nel tempo minimo $t_f$.

Mentre il controllo ottimo nel tempo per i doppi integratori è ben compreso, il caso del triplo integratore presenta sfide significative, in particolare quando si tratta di:

1. Vincoli asimmetrici: Dove i limiti superiori e inferiori per il jerk e gli stati non sono uguali in magnitudine.
2. Condizioni al contorno non stazionarie: Stati iniziali e terminali arbitrari.
3. Vincoli di posizione attivi: Scenari in cui la traiettoria deve toccare o scorrere lungo i confini dei vincoli di posizione ($x_3 = \bar{x}_3$ o $x_3 = \underline{x}_3$).

Le soluzioni esistenti, come l'algoritmo commerciale Ruckig (versione community), spesso falliscono sotto vincoli asimmetrici o vincoli di posizione attivi. I precedenti approcci analitici hanno ignorato i vincoli di stato, assunto vincoli simmetrici o non fornito una caratterizzazione completa delle superfici di commutazione e delle condizioni attive per i vincoli di posizione.

Metodologia
Gli autori utilizzano il Principio del Massimo di Pontryagin (PMP) per caratterizzare la legge di controllo ottima, che segue una struttura Bang-Bang-Singolare (BBS). Il cuore della metodologia consiste in un'analisi geometrica dello spazio degli stati per derivare superfici di commutazione ottimali nel tempo.

1. Legge di Commutazione Aumentata (ASL): La traiettoria ottima è rappresentata come una sequenza di archi (archi bang-bang non vincolati e archi vincolati dove gli stati sono fissi) e "marcatori tangenti". Un marcatore tangente si verifica quando il vincolo di posizione diventa attivo tangenzialmente (cioè $x_3 = \bar{x}_3$, $x_2 = 0$ e $x_1 \geq 0$).
2. Costruzione della Superficie di Commutazione:
   • Senza Vincoli di Posizione: Gli autori costruiscono varietà di commutazione mediante integrazione all'indietro dallo stato terminale $\mathbf{x}_f$. Definiscono superfici corrispondenti a specifiche ASL (ad esempio, $\bar{0}\bar{0}\bar{0}$, $\bar{0}\bar{1}\bar{0}\bar{0}$) che partizionano lo spazio degli stati 3D.
   • Con Vincoli di Posizione: L'articolo deriva le condizioni specifiche sotto le quali i vincoli di posizione diventano attivi. Introduce nuove superfici di commutazione (ad esempio, $\bar{0}(\bar{3}, 2)\bar{0}\bar{0}\bar{0}$) che tengono conto delle traiettorie tangenti al confine di posizione. Il Teorema 2 fornisce una classificazione completa di tutte le possibili forme ASL per il triplo integratore con vincoli a scatola completi, stabilendo che le traiettorie ottimali consistono in sequenze di archi non vincolati e marcatori tangenti.
3. Implementazione Algoritmica:
   • Algoritmo 1: Determina la direzione relativa tra $\mathbf{x}_0$ e $\mathbf{x}_f$ analizzando proiezioni del 2° ordine, gestendo i casi in cui le superfici di commutazione sono multi-valore.
   • Algoritmo 2: Risolve il problema senza vincoli di posizione collegando gli stati tramite controlli ottimali del 2° ordine e risolvendo equazioni polinomiali per le durate degli archi.
   • Algoritmo 3: Estende la soluzione ai vincoli a scatola completi. Se la soluzione non vincolata viola i vincoli di posizione, l'algoritmo collega ricorsivamente lo stato a un marcatore tangente (derivato dal Teorema 2) e risolve i sottoproblemi.
   • Il sistema di equazioni per le durate degli archi è risolto utilizzando basi di Gröbner, riducendo il problema a una singola equazione polinomiale di grado $\leq 6$.

Contributi Chiave

• Caratterizzazione Completa delle Superfici di Commutazione: Per la prima volta, l'articolo fornisce una caratterizzazione analitica completa delle superfici di commutazione ottimali nel tempo per il triplo integratore sotto vincoli a scatola completi, inclusa la struttura geometrica delle soluzioni con vincoli di posizione attivi.
• Derivazione delle Condizioni Attive: L'articolo deriva esplicitamente le condizioni sotto le quali i vincoli di posizione diventano attivi (la condizione del "marcatore tangente"), un vuoto precedentemente assente nella letteratura.
• Teorema 2 (Classificazione ASL): Stabilisce l'insieme completo delle Leggi di Commutazione Aumentate ammissibili per questo problema, dimostrando che le traiettorie ottimali seguono sequenze specifiche che coinvolgono marcatori tangenti.
• Algoritmo Efficiente: Viene proposto un algoritmo che pianifica traiettorie ottimali nel tempo per stati al contorno arbitrari e vincoli asimmetrici.

Risultati
Il metodo proposto è stato valutato rispetto a tre baseline: Ruckig (versione community), CasADi (basato su IPOPT) e SCP (Programmazione Convessa Sequenziale).

• Tasso di Successo: Il metodo proposto ha raggiunto un tasso di successo del 100% nel trovare soluzioni fattibili sia per casi simmetrici (Caso 1) che asimmetrici con vincoli di posizione attivi (Caso 2). Al contrario, Ruckig ha fallito nel Caso 2 a causa dell'asimmetria, mentre SCP/CasADi hanno mostrato tassi di successo significativamente inferiori (rispettivamente 34,1% e 97,7% nel Caso 2).
• Efficienza Computazionale: Il tempo computazionale medio per traiettoria è stato di circa 10 $\mu$s (specificamente $2,38 \times 10^{-6}$ s per il Caso 1 e $1,25 \times 10^{-5}$ s per il Caso 2). Ciò rappresenta una riduzione di 5 ordini di grandezza rispetto alle baseline basate sull'ottimizzazione (CasADi: ~0,28 s; SCP: ~7,28 s).
• Ottimalità: Il metodo ha trovato costantemente soluzioni globalmente ottimali. Nei casi di test in cui i metodi basati sull'ottimizzazione convergevano a ottimi locali (ASL subottimali), il metodo proposto ha ridotto il tempo terminale fino al 90,9% (Caso 1) e 73,4% (Caso 2).

Significato
Gli autori affermano che questo lavoro fornisce la prima caratterizzazione completa delle superfici di commutazione e un algoritmo efficiente per il problema di controllo ottimo nel tempo del 3° ordine in condizioni terminali non stazionarie e con vincoli di posizione attivi. Spostandosi dall'ottimizzazione iterativa verso una soluzione geometrica e analitica, l'articolo dimostra che un controllo ottimo nel tempo ad alta precisione può essere raggiunto con tempi di calcolo dell'ordine dei microsecondi, rendendolo altamente adatto per applicazioni industriali in tempo reale come il movimento robotico e la lavorazione a controllo numerico, dove i vincoli sono spesso asimmetrici e attivi.