Mismatch-Aware Adaptive Constraint Tightening for Bicycle-Model Trajectory Optimization

Riepilogo Tecnico: Restringimento Adattivo dei Vincoli Consapevole del Disallineamento per l'Ottimizzazione della Traiettoria con Modello di Bicicletta

Enunciato del Problema
L'ottimizzazione della traiettoria per veicoli autonomi si basa frequentemente sul modello cinematico di bicicletta a causa della sua efficienza computazionale, abilitando metodi come la Programmazione Convessa Sequenziale (SCP) e lo shooting diretto. Tuttavia, esiste un critico "divario pianificatore-esecutore": il modello cinematico ignora lo sbandamento laterale, la rigidità degli pneumatici e l'accoppiamento imbardata-laterale intrinseci alla dinamica reale del veicolo. Quando un piano cinematico viene eseguito su un veicolo dinamico, i vincoli di sicurezza (ad esempio, i confini della corsia) possono essere violati. Le soluzioni attuali affrontano tipicamente questo problema applicando un margine di sicurezza fisso e nel caso peggiore ($\epsilon$). Questo approccio è eccessivamente conservativo a basse velocità o basse curvature, restringendo inutilmente lo spazio delle soluzioni ammissibili, eppure può risultare insufficiente se il margine non è dimensionato correttamente per manovre ad alta velocità e ad alta curvatura.

Metodologia
Il documento propone il Restringimento Adattivo dei Vincoli Consapevole del Disallineamento (MACT), un metodo che sostituisce il margine di sicurezza fisso con uno dipendente dallo stato, derivato da limiti analitici sul disallineamento cinematico-dinamico.

1. Derivazione Teorica dei Regimi di Disallineamento:

   • Gli autori derivano una velocità caratteristica $v_c = \sqrt{C_\alpha L / M}$, dove $C_\alpha$ è la rigidità media di curvatura, $L$ è il passo, e $M$ è la massa.
   • Sotto $v_c$: Il veicolo dinamico inizialmente sovrasterza verso l'interno rispetto al piano cinematico, il che è sicuro per i vincoli di corsia esterni.
   • Sopra $v_c$: Il veicolo sottosterza verso l'esterno, creando una deviazione critica per la sicurezza.
   • Si dimostra che la massima deviazione esterna $\epsilon^*$ segue un'esatta scala temporale $T^2$ (dove $T$ è l'orizzonte di pianificazione). Il coefficiente di questa scala transita tra un limite transitorio (dominante per orizzonti brevi) e un limite stazionario (dominante per orizzonti lunghi).

2. Calcolo Analitico del Coefficiente:

   • Il documento deriva un coefficiente analitico senza simulazione $a_2^{anal} = \frac{1}{2}(1 - v_c^2/v_{max}^2)T^2$.
   • Questo coefficiente permette il calcolo di un termine di restringimento $\epsilon(v, \kappa) = a_2 v^2 |\kappa|$ utilizzando solo i parametri del veicolo e l'orizzonte di pianificazione, senza richiedere simulazioni offline o adattamento dei dati.

3. Integrazione nell'Ottimizzazione:

   • Il termine di restringimento è integrato nei vincoli di ottimizzazione della traiettoria. Per un vincolo di corsia $|y_t - y_{ref}| \leq w/2$, il vincolo restringuto diventa $|y_t - y_{ref}| \leq w/2 - a_2 v_t^2 |\kappa_t|$.
   • Questa formulazione è differenziabile e compatibile con i solver MPC non lineari a shooting diretto (ad esempio, IPOPT).

Contributi Chiave

• Caratterizzazione Teorica: Identificazione della velocità caratteristica $v_c$ come soglia che separa i regimi di disallineamento verso l'interno (sicuri) e verso l'esterno (insicuri).
• Dimostrazione della Legge di Scala: Dimostrazione che la massima deviazione esterna scala come $v^2 \kappa T^2$, con limiti espliciti sia per i regimi transitori che stazionari.
• Certificato di Sicurezza Senza Simulazione: Derivazione di $a_2^{anal}$, un coefficiente calcolabile esclusivamente dai parametri del veicolo e dalla lunghezza dell'orizzonte, garantendo la sicurezza senza calibrazione offline.
• Framework MACT: Un algoritmo pratico che adatta il restringimento dei vincoli in base alla velocità istantanea e alla curvatura, riducendo significativamente il conservatorismo rispetto ai margini fissi.

Risultati Sperimentali
Gli autori validano la teoria attraverso otto esperimenti numerici:

• Verifica della Scala: Esperimenti su un veicolo dinamico a 2 gradi di libertà confermano che la massima deviazione esterna segue strettamente la scala predetta $v^2 \kappa T^2$ attraverso varie velocità, curvature e orizzonti.
• Sicurezza vs. Conservatorismo: In una griglia di 20 scenari, MACT ha raggiunto il 100% di sicurezza riducendo il margine sprecato dell'84% rispetto a una linea di base con margine fisso nel caso peggiore.
• Generalizzazione: È stato osservato che la legge di scala $v^2 \kappa$ vale anche per una bicicletta inclinata non lineare (un diverso meccanismo fisico che coinvolge la dinamica di inclinazione), con un adattamento $R^2 = 0.934$, nonostante la mancanza di una derivazione teorica per questo caso specifico.
• Prestazioni in Anello Chiuso: In un confronto MPC a shooting diretto contro Tube MPC e linee di base adattive online:
  • MACT ha mantenuto il 100% di sicurezza.
  • Ha ridotto il margine applicato medio del 34% rispetto a Tube MPC.
  • A differenza delle linee di base adattive che subiscono ritardi durante i transitori, MACT ha fornito il margine specifico dello scenario corretto fin dal primo passo di controllo.
  • Il tempo di calcolo è rimasto sotto i 10 ms per passo, ben entro le finestre di ripianificazione in tempo reale.

Significato e Affermazioni
Il documento afferma che il disallineamento tra la pianificazione cinematica e l'esecuzione dinamica non è rumore casuale, ma un fenomeno strutturato governato dai parametri del veicolo e dalle condizioni operative. Modellando esplicitamente la scala $v^2 \kappa T^2$, MACT permette ai pianificatori di "rilassare" i vincoli su percorsi dolci mantenendo al contempo una sicurezza rigorosa su quelli aggressivi.

Gli autori sono modesti riguardo alla portata delle loro affermazioni:

• I limiti derivati sono risultati di primo ordine per pneumatici lineari. Sono validi all'interno del regime lineare degli pneumatici, ma non tengono conto della saturazione degli pneumatici, del ritardo degli attuatori dello sterzo o delle oscillazioni transitorie oltre il primo tempo di assestamento. Questi fattori richiederebbero margini aggiuntivi al di fuori del framework MACT.
• La generalizzazione alla bicicletta inclinata è presentata come un'osservazione empirica ("ciò che osserviamo") piuttosto che come una legge universale derivata, poiché i meccanismi fisici (inclinazione vs sbandamento degli pneumatici) differiscono.
• Il coefficiente analitico si basa su una $v_{max}$ nota; se il veicolo supera questo limite assunto, la garanzia non è più valida.

In sintesi, il documento fornisce un metodo analitico e fondato per restringere adattivamente i vincoli della traiettoria, colmando il divario tra una pianificazione cinematica efficiente e un'esecuzione dinamica sicura senza la necessità di margini fissi conservativi o di apprendimento online complesso.