Riepilogo Tecnico: C-ZUPT: Sorvolo Stazionario Assistito dalla Stazionarietà

Enunciato del Problema

I sistemi autonomi che operano in ambienti privi di GNSS (Global Navigation Satellite System) affrontano una sfida critica: mantenere una stima accurata dello stato per durate prolungate. Sebbene i sistemi di navigazione inerziale (INS) si basino su misurazioni ad alta frequenza, sono intrinsecamente soggetti a deriva causata da bias e rumore dei sensori. In assenza di correzioni esterne (come aggiornamenti GNSS o visivi), gli errori di stima si accumulano senza controllo, portando alla divergenza del filtro e alla perdita di controllo.

Le soluzioni tradizionali, come gli aggiornamenti a velocità zero (ZUPT), sono altamente efficaci per piattaforme vincolate al suolo (ad esempio, pedoni, veicoli) sfruttando i periodi di riposo fisico. Tuttavia, questi metodi sono generalmente inapplicabili alle piattaforme aeree come i quadricotteri, che raramente raggiungono una velocità zero reale anche durante il sorvolo stazionario a causa della necessità di un controllo attivo continuo per contrastare le perturbazioni. Di conseguenza, i sistemi aerei mancano di un meccanismo affidabile e privo di sensori per ancorare la loro stima dello stato durante le fasi di volo stazionario, portando a un rapido degrado dell'accuratezza e a un aumento del consumo energetico mentre i controllori combattono contro errori accumulati.

Metodologia

Gli autori propongono l'Aggiornamento a Velocità Zero Controllato (C-ZUPT), un approccio di correzione dello stato privo di sensori progettato specificamente per la navigazione aerea. La metodologia integra tre componenti fondamentali:

1. Quadro Teorico e Modellazione

Il sistema modella il quadricottero come un sistema dinamico a tempo continuo linearizzato attorno a un punto di equilibrio di sorvolo stazionario.

• Dinamica: Un quadro Newton-Euler descrive il moto a 6 gradi di libertà (DoF), tenendo conto della spinta, della gravità e della resistenza aerodinamica (trascurata a basse velocità).
• Architettura di Controllo: Il sistema impiega un controllore Lineare-Quadratico-Gaussiano (LQG), che combina un Regolatore Lineare-Quadratico (LQR) per il controllo con un Filtro di Kalman (KF) per la stima dello stato.
• Modellazione della Batteria: Per valutare l'efficienza energetica, un modello di circuito equivalente basato su Thevenin simula la dinamica della batteria, inclusi l'abbassamento di tensione, l'evoluzione dello stato di carica (SoC) e le risposte transitorie a richieste di corrente elevate.

2. Il Meccanismo C-ZUPT

L'innovazione centrale è un'euristica che identifica "equilibri quasi-statici" durante il volo per attivare correzioni ZUPT senza richiedere il contatto fisico con una superficie.

• Logica di Rilevamento: L'algoritmo monitora le norme $L_2$ delle velocità stimate del corpo ($\hat{v}_B$) e delle forze specifiche ($\tilde{f}$) su una finestra scorrevole ($K$ campioni).
• Condizione di Attivazione: Quando entrambe le norme scendono al di sotto di soglie predefinite ($\delta_{\hat{v}}$ e $\delta_{\tilde{f}}$), il sistema assume uno stato quasi stazionario.
• Correzione: Al rilevamento, il filtro applica un aggiornamento di pseudo-misurazione ($y_k = 0$) agli stati di velocità, resettando efficacemente l'errore di velocità e limitando la crescita dell'incertezza. Ciò è implementato come un meccanismo di "assistenza informativa", agendo come una misurazione sintetica derivata dalla fisica dell'equilibrio di sorvolo stazionario.

3. Flusso del Segnale e Implementazione

L'approccio tiene conto delle non idealità del mondo reale nel ciclo di controllo:

• Elaborazione dei Comandi: Gli output LQR sono convertiti in velocità dei rotori tramite un risolutore ai minimi quadrati non negativi (NNLS) per garantire la fattibilità fisica, seguiti dalla generazione PWM.
• Dinamica degli Attuatori: L'inerzia dei rotori e i ritardi aerodinamici sono modellati come sistemi del primo ordine, creando un ritardo tra comando e spinta effettiva.
• Integrazione: L'aggiornamento C-ZUPT bypassa il passo di previsione standard nel KF quando viene rilevata la stazionarietà, iniettando il vincolo a velocità zero direttamente nel ciclo di stima.

Contributi Chiave

1. ZUPT Aerea Senza Sensori: Il documento introduce la prima implementazione ZUPT per piattaforme aeree che non si basa sul contatto con la superficie, sfruttando il controllo attivo per mantenere un equilibrio quasi-statico.
2. Navigazione Resiliente alla Deriva: Un metodo specifico di correzione della velocità adattato ai quadricotteri che sopprime la deriva durante le fasi stazionarie, validato attraverso un framework pubblicamente disponibile.
3. Stima Consapevole della Batteria: Un modello di circuito integrato che consente il monitoraggio energetico in tempo reale, permettendo agli autori di quantificare la relazione tra accuratezza della stima e consumo energetico.
4. Modellazione del Movimento ad Alta Fedeltà: Un modello di sistema completo che accoppia il controllo LQG con la dinamica della batteria e i ritardi degli attuatori per simulare condizioni di volo realistiche sotto limitazioni sensoriali.

Risultati e Analisi

Sono state condotte estese simulazioni per valutare il sistema sotto diverse velocità di aggiornamento ($\Gamma$) e livelli di perturbazione, confrontando il sistema assistito da C-ZUPT con una linea di base non assistita.

• Stabilità e Riduzione dell'Errore: In scenari con aggiornamenti GNSS radi (ad esempio, $\Gamma = 0.005$), il sistema non assistito ha mostrato una significativa divergenza negli errori di stima e di controllo. Il sistema C-ZUPT ha mantenuto la stabilità, riducendo:
  • L'errore di tracciamento del 28,8%
  • L'errore di assetto del 21,6%
  • Il tempo di saturazione del controllo del 76,9%
  • L'incertezza di stima del 28%
• Sforzo di Controllo: Correggendo la deriva di velocità, C-ZUPT ha ridotto lo sforzo di controllo richiesto per mantenere il sorvolo stazionario di circa il 31,9%.
• Efficienza Energetica: La riduzione dello sforzo di controllo si è tradotta direttamente in risparmi energetici. Il sistema C-ZUPT ha dimostrato una riduzione del 3% al 7% nel consumo medio di potenza e nel prelievo di corrente rispetto alla linea di base.
• Estensione del Tempo di Volo: Grazie al miglioramento dell'efficienza, il tempo di sorvolo sicuro stimato (prima di raggiungere il 30% di SoC della batteria) è aumentato di quasi 1 minuto attraverso tutti i livelli di perturbazione testati, rappresentando un miglioramento del 3% al 6% nell'efficienza complessiva del sistema.

Significato e Affermazioni

Gli autori affermano che C-ZUPT fornisce una soluzione pratica per estendere la durata operativa dei sistemi aerei vincolati dalle risorse in ambienti privi di GNSS. Sfruttando la stabilità intrinseca del sorvolo stazionario controllato, il metodo mitiga la divergenza del filtro e migliora la stabilità della navigazione senza richiedere sensori aggiuntivi.

Il documento sostiene che questi miglioramenti sono critici per missioni sensibili al tempo in cui l'efficienza energetica e il volo prolungato sono fondamentali, citando specificamente applicazioni in:

• Guerra urbana e polizia
• Operazioni di soccorso
• Sorveglianza persistente
• Ispezione delle infrastrutture
• Servizi di consegna

Gli autori riconoscono le limitazioni, notando che il metodo si basa su dinamiche moderate (gli errori di velocità devono rimanere limitati) e richiede una regolazione attenta dei parametri euristici (soglie e dimensioni della finestra) per bilanciare la sensibilità contro i falsi positivi. Tuttavia, lo studio conclude che C-ZUPT trasforma efficacemente gli intervalli di stazionarietà aerea in una risorsa chiave per una navigazione robusta e priva di sensori.