Coordinated Trajectory Control Algorithm for Quadcopter Motion along a Smooth Spatial Trajectory

Riepilogo Tecnico: Algoritmo di Controllo Coordinato della Traiettoria per il Movimento di un Quadricottero lungo una Traiettoria Spaziale Liscia

Enunciato del Problema
Il documento affronta la sfida del controllo di un quadricottero per muoversi lungo una traiettoria spaziale tridimensionale e liscia. Gli autori distinguono tra due paradigmi di controllo principali: il controllo di inseguimento, in cui il robot tenta di raggiungere una posizione specifica in un momento specifico (spesso portando a soluzioni di percorso più breve che possono fallire in ambienti ricchi di ostacoli), e il controllo coordinato. Nel controllo coordinato, la traiettoria e il profilo di velocità lungo quella curva sono pre-specificati. L'obiettivo del controllo è minimizzare la deviazione dal percorso, piuttosto che la distanza da un punto specifico nel tempo, consentendo al veicolo di navigare attorno agli ostacoli regolando la sua velocità lungo la curva.

Il problema specifico affrontato qui coinvolge un modello dinamico non lineare di un quadricottero in cui il grado relativo dei canali di controllo non è identico, complicando la decomposizione del modello. Inoltre, la soluzione proposta deve basarsi esclusivamente su misurazioni dell'uscita (coordinate lineari $x, y, z$ e angolo di imbardata $\psi$) piuttosto che su misurazioni complete del vettore di stato, il che rappresenta un vincolo significativo rispetto agli approcci esistenti basati sul feedback di stato.

Metodologia
Gli autori sviluppano una sintesi di controllo basata su un approccio geometrico e un feedback di uscita robusto:

1. Modellazione Dinamica e Definizione della Deviazione:
   Viene stabilito un modello non lineare completo del quadricottero, che tiene conto delle coordinate lineari e dell'orientamento (imbardata, beccheggio, rollio). La deviazione dalla traiettoria desiderata $S$ è definita utilizzando una trasformazione di coordinate. Ciò comporta:

   • Una coordinata di percorso $s$ che rappresenta il punto più vicino sulla curva.
   • Due coordinate di errore lineari ($e_1, e_2$) che rappresentano la distanza da due piani che si intersecano nel vettore di velocità desiderato.
   • Errori angolari ($\delta\phi, \delta\theta, \delta\psi$), dove il beccheggio e il rollio desiderati sono assunti nulli, e l'imbardata desiderata è derivata dalla proiezione della traiettoria.

2. Trasformazione in Forma Normale:
   Per facilitare la progettazione del controllo, il sistema è trasformato in una "forma normale" utilizzando una sequenza di differenziazioni e cambi di coordinate. Gli autori introducono variabili ausiliarie e integratori per gestire la saturazione dell'ingresso di controllo della spinta ($u_1$). Questa trasformazione risulta in un sistema in cui le variabili regolate ($\xi_1$) e le loro derivate ($\xi_2, \xi_3, \xi_4$) formano un vettore di stato esteso. Il sistema è mostrato come invertibile, permettendo la ricostruzione degli ingressi di controllo originali dalle variabili della forma normale.

3. Sintesi del Controllo a Feedback di Uscita Robusto:

   • Feedback di Stato Ideale: Inizialmente, una legge di controllo è sintetizzata assumendo la disponibilità completa dello stato. Questa legge utilizza una struttura di feedback lineare con guadagni ($\gamma_1$ fino a $\gamma_4$) scelti per formare un polinomio di Hurwitz, garantendo la stabilità asintotica locale della dinamica dell'errore.
   • Implementazione del Feedback di Uscita: Riconoscendo che la misurazione completa dello stato non è disponibile, gli autori impiegano un metodo di osservatore esteso. Viene progettato un osservatore ad alto guadagno per stimare gli stati non misurati ($\hat{\xi}_2, \hat{\xi}_3, \hat{\xi}_4$) e il termine di disturbo sconosciuto ($\hat{\sigma}$).
   • Legge di Controllo: La legge di controllo finale utilizza questi stati stimati e include una funzione di saturazione liscia per garantire che gli ingressi di controllo rimangano entro i limiti fisici. Le forze di spinta per le quattro eliche sono calcolate invertendo la matrice di trasformazione derivata dalla forma normale.

Contributi Chiave

• Modello 3D Completo: A differenza di lavori precedenti che utilizzavano modelli incompleti ignorando la dinamica dell'imbardata o erano limitati al moto planare, questo documento presenta un modello dinamico completo per il movimento del quadricottero nello spazio 3D.
• Controllo Coordinato a Feedback di Uscita: Il documento sintetizza una legge di controllo coordinata che si basa esclusivamente su misurazioni delle coordinate lineari e dell'angolo di imbardata, affrontando la difficoltà dei gradi relativi non identici nei canali di controllo.
• Semplificazione della Sintonizzazione: Utilizzando integratori aggiuntivi e un algoritmo di controllo dinamico, gli autori propongono una metodologia con una sintonizzazione del regolatore semplificata rispetto ai precedenti algoritmi di controllo di inseguimento che richiedevano una selezione complessa dei parametri per soddisfare le condizioni di dimostrazione.
• Robustezza: L'inclusione di un osservatore esteso permette al sistema di gestire termini e disturbi sconosciuti, fornendo una soluzione robusta per l'inseguimento della traiettoria.

Risultati e Affermazioni
Il documento fornisce una dimostrazione teorica della stabilità locale per il sistema ad anello chiuso. Gli autori dimostrano che se i parametri del controllore sono scelti come coefficienti di un polinomio di Hurwitz, le variabili di deviazione ($\tilde{\xi}$) tendono asintoticamente a zero. Ciò garantisce che il quadricottero:

1. Segua la curva spaziale prescritta.
2. Mantenga il profilo di velocità prescritto lungo la curva.
3. Mantenga gli errori di orientamento entro limiti limitati.

La derivazione matematica conferma che la legge di controllo raggiunge gli obiettivi di minimizzare la deviazione dalla traiettoria e mantenere la velocità e l'orientamento desiderati, a condizione che la curvatura della traiettoria sia limitata e le condizioni iniziali siano all'interno della regione di attrazione.

Significato
Il documento afferma di colmare una lacuna nella letteratura estendendo il controllo coordinato della traiettoria dai robot mobili planari al movimento 3D del quadricottero utilizzando esclusivamente feedback di uscita. Si contrappone ai lavori precedenti che utilizzavano modelli incompleti o richiedevano misurazioni complete dello stato. Il significato risiede nel fornire un algoritmo teoricamente fondato e robusto per l'inseguimento di percorsi spaziali che è praticamente implementabile date le limitazioni standard dei sensori (posizione e imbardata), senza la necessità di una complessa stima dello stato delle velocità angolari o dei vettori di orientamento completi. Gli autori notano che, sebbene il quadro teorico sia stabilito, sono pianificati studi sperimentali su larga scala per lavori futuri per validare la legge di controllo sintetizzata.