Compliant Explicit Reference Governor for Contact Friendly Robotic Manipulators

Riepilogo Tecnico: Governatore di Riferimento Esplicito Compliant per Manipolatori Robotici a Contatto Amichevole

Enunciato del Problema
La pianificazione del movimento robotica tradizionale dà priorità all'evitamento delle collisioni per garantire la sicurezza, trattando spesso il contatto ambientale come un ostacolo. Tuttavia, la robotica moderna richiede sempre più capacità "ricche di contatto" in cui l'interazione fisica è una risorsa. La sfida principale risiede nella gestione della transizione tra movimento libero e contatto, soddisfacendo due tipi distinti di vincoli:

1. Vincoli Rigidi: Limiti non negoziabili come gli intervalli delle giunture, i limiti di coppia e le superfici proibite.
2. Vincoli Morbidi: Condizioni in cui il contatto è consentito ma deve essere gestito in sicurezza. Questi creano condizioni "OR" altamente non convesse: il robot deve o evitare completamente il contatto oppure operare sotto specifiche restrizioni di sicurezza al contatto.

Le strategie esistenti basate sull'ottimizzazione (ad esempio, il Controllo Predittivo di Modello) richiedono spesso ridisegni completi delle leggi di controllo e complesse approssimazioni temporali variabili della dinamica di contatto, poco attraenti per i praticanti con controllori legacy. Al contrario, approcci gerarchici come le Funzioni di Barriera di Controllo o la compliance basata sull'energia spesso mancano di garanzie di vincoli rigorosi o di stabilità asintotica. Il Governatore di Riferimento Esplicito (ERG) offre un filtro di sicurezza gerarchico che modifica i riferimenti senza alterare il controllore sottostante, ma le implementazioni precedenti trattavano il contatto come indesiderabile, fermando il movimento al momento del contatto. Questo articolo affronta la necessità di un quadro che consenta un'operazione sicura e continua durante il contatto senza modificare il controllore di basso livello.

Metodologia: Il Governatore di Riferimento Esplicito Compliant (CERG)
Gli autori propongono il Governatore di Riferimento Esplicito Compliant (CERG), un sistema modulare di gestione dei riferimenti posizionato tra un pianificatore di alto livello e un controllore di basso livello. Il CERG impone vincoli operativi e abilita transizioni fluide tra operazioni in movimento libero e operazioni a contatto manipolando il segnale di riferimento $v(t)$ inviato a un controllore pre-stabilizzato.

La metodologia si basa su tre componenti chiave:

1. Livello di Pre-stabilizzazione: Un controllore PD standard con compensazione di gravità guida il robot verso una configurazione di riferimento $v$. L'energia totale del sistema (cinetica + potenziale virtuale) è definita da una funzione di Lyapunov $V(x, v)$, che è monotona decrescente quando $v$ è costante.
2. Margine di Sicurezza Dinamico Compliant (DSM): L'innovazione centrale è un DSM, $\Delta(x, v)$, progettato per gestire la natura disgiuntiva (OR) dei vincoli di contatto. La condizione di sicurezza è formulata come:
   $$s(q(t)) < 0 \quad \lor \quad V(x(t), v(t)) \le E_{\max}$$
   dove $s(q) < 0$ rappresenta il movimento libero e $V \le E_{\max}$ rappresenta un contatto sicuro con energia limitata. Il CERG costruisce un DSM composito:
   $$\Delta(x, v) = \min(\Delta_h, \max(\Delta_s, \Delta_E))$$
   • $\Delta_h$: Impone vincoli rigidi (limiti delle giunture, ecc.).
   • $\Delta_s$: Un margine basato sulla traiettoria per la superficie di vincolo morbido $s(q)$.
   • $\Delta_E$: Un margine basato sull'energia definito come $\kappa_E(E_{\max} - V(x, v))$.
     Questa struttura garantisce che, se il robot è in movimento libero, il vincolo energetico venga rilassato; se si verifica un contatto, l'energia totale del sistema sia strettamente limitata da $E_{\max}$.
3. Campo di Navigazione Morbido (NF): A differenza dei vincoli rigidi che respingono il riferimento, il CERG impiega un campo di repulsione "morbido" $\rho_s(v)$ che permette al riferimento $v$ di penetrare il confine del vincolo fino a un limite $\delta_s$. Questa penetrazione è necessaria per generare la forza richiesta per il contatto compliant. Il campo di navigazione totale combina l'attrazione verso il target, la repulsione dai vincoli rigidi e questa repulsione morbida.

Contributi Chiave
L'articolo rivendica tre contributi principali:

• Filtraggio Modulare dei Riferimenti: Un quadro che transita senza soluzione di continuità tra movimento senza contatto e movimento ricco di contatto, rispettando i vincoli di angolo, velocità e coppia delle giunture, senza richiedere un ridisegno del controllore.
• Gestione dei Vincoli Disgiuntivi: Un meccanismo di sicurezza specificamente progettato per vincoli di tipo "OR", garantendo la soddisfazione dimostrabile o dell'evitamento del contatto o del mantenimento di un'energia limitata durante il contatto.
• Linea Guida di Sicurezza Basata sull'Energia: Una metrica di sicurezza basata sull'energia meccanica totale (potenziale + cinetica) del sistema in anello chiuso. Questa metrica è invariante rispetto al sistema di riferimento, si lega direttamente alle garanzie di stabilità ed è facilmente interpretabile.

Risultati e Validazione
Il CERG è stato validato numericamente e sperimentalmente su sistemi di crescente complessità:

• Braccio Piano a Due Giunti (Simulazione): Il CERG è stato testato con controllori sia nello spazio delle giunture che nello spazio dell'end-effector. I risultati hanno mostrato che il CERG ha ridotto con successo le forze di interazione rispetto all'operatività senza di esso e ha rispettato i limiti energetici. Lo studio ha notato che, sebbene la formulazione nello spazio dell'end-effector minimizzi l'errore cartesiano, la formulazione nello spazio delle giunture è preferibile per architetture gerarchiche.
• Simulazione Franka Emika Panda (Drake): Utilizzando un modello di contatto compliant con attrito e dissipazione, il CERG è stato testato su un compito che richiedeva al braccio di scivolare lungo una parete. La simulazione ha confermato che il CERG ha aderito al limite $E_{\max}$ durante il contatto, mentre un ERG standard (che si ferma al contatto) e un sistema non modificato non sono riusciti a gestire efficacemente la transizione energetica.
• Esperimenti nel Mondo Reale (Franka Emika Panda): Sono stati eseguiti due compiti:
  1. Pulizia della Lavagna: Un compito non altamente sensibile all'energia. CERG, ERG e controllo ad Impedenza hanno completato tutti il compito, ma solo il CERG ha imposto vincoli rigidi (prevenendo violazioni della velocità delle giunture) e limiti energetici durante il contatto.
  2. Spinta della Torre Jenga: Un compito altamente sensibile all'energia. Il controllore ad Impedenza ha fallito a causa di violazioni del limite delle giunture o del rovesciamento della torre. L'ERG standard non ha impedito il rovesciamento a causa di un'energia di contatto eccessiva. Solo il CERG ha spinto con successo la torre senza rovesciarla, imponendo rigorosamente $E_{\max}$ durante il contatto mentre permetteva un'energia più elevata nel movimento libero.

Significato e Rivendicazioni
L'articolo afferma che il CERG fornisce una soluzione pratica per la manipolazione ricca di contatto agendo come un filtro di sicurezza "plug-and-play". La sua importanza risiede nel permettere ai robot di trattare il contatto come una risorsa piuttosto che come un pericolo, senza il carico computazionale di ridisegni completi dell'MPC o i rischi di instabilità dei controllori non modificati. Il quadro garantisce la sicurezza attraverso vincoli dimostrabili sull'energia totale del sistema, consentendo transizioni di fase senza soluzione di continuità tra movimento libero e contatto. Gli autori concludono che l'approccio è fattibile ed efficace, con lavori futuri pianificati per interfacciare il CERG con pianificatori orientati al compito.