A Geometric Task-Space Port-Hamiltonian Formulation for Redundant Manipulators

Sintesi Tecnica: Una Formulazione Port-Hamiltoniana Geometrica per lo Spazio dei Compiti di Manipolatori Ridondanti

Definizione del Problema
I manipolatori ridondanti, che possiedono più gradi di libertà (DOF) rispetto a quelli richiesti per un compito cinematico differenziale specifico, rappresentano una sfida nella modellazione e nel controllo. Sebbene le formulazioni lagrangiane per la ridondanza siano ben consolidate in letteratura (ad es., Dietrich et al., 2015; Ott et al., 2015), esiste la necessità di un quadro geometrico rigoroso all'interno del formalismo Port-Hamiltoniano (pH) che gestisca esplicitamente la decomposizione dell'energia e della potenza tra lo spazio del compito (task space) e lo spazio nullo (null space). Gli approoli pH esistenti per la modellazione dell'impedenza nello spazio del compito (ad es., Scherpen et al., 2025) spesso si occupano di sistemi non ridondanti o non sfruttano appieno le proprietà strutturali della ridondanza. Il problema centrale affrontato è la mancanza di un modello pH che decomponga naturalmente i porti di quantità di moto e di potenza del sistema nei componenti dello spazio del compito e dello spazio nullo, facilitando l'analisi basata sull'energia e la progettazione del controllo.

Metodologia
Gli autori propongono una nuova formulazione pH geometrica derivata da una trasformazione di coordinate della standard dinamica Hamiltoniana. La metodologia procede attraverso le seguenti fasi:

1. Decomposizione Geometrica:

   • Spazio delle Velocità: Utilizzando la metrica d'inerzia $M(q)$, lo spazio tangente $T_qQ$ viene decomposto nel nucleo (kernel) dello Jacobiano del compito $J(q)$ (spazio nullo) e nel suo complemento $M$-ortogonale. Ciò consente di scomporre univocamente la velocità articolare $\dot{q}$ in una componente dello spazio del compito $v$ e una componente dello spazio nullo $\nu$.
   • Spazio delle Forze: Viene applicata una decomposizione duale allo spazio delle forze generalizzate $T^*_qQ$. La coppia $\tau$ viene scomposta in una componente $\tau_F$ nell'immagine di $J^\top$ (forze dello spazio del compito) e una componente $\tau_0$ nell'annullatore del sottospazio di velocità dello spazio del compito (forze dello spazio nullo).
   • Bilancio della Potenza: Questa decomposizione rivela che la potenza meccanica $\tau^\top \dot{q}$ si scinde in due termini indipendenti: $\tau_F^\top v$ (potenza del compito) e $\tau_0^\top \nu$ (potenza dello spazio nullo).

2. Trasformazione di Coordinate:

   • Per integrare questa decomposizione nella struttura pH, gli autori definiscono una velocità estesa del compito $\eta_e = \bar{J}(q)\dot{q}$, dove $\bar{J}$ combina lo Jacobiano del compito $J$ e una matrice di base dello spazio nullo $N$.
   • Viene applicata una trasformazione di coordinate $\Phi$ alla standard dinamica Hamiltoniana $(q, p)$, trasformando la quantità di moto $p$ nella quantità di moto estesa $\pi_e = \bar{J}^{-\top}(q)p$.
   • Questa trasformazione produce un nuovo vettore di stato $z = (q, \pi, \pi_\nu)$, dove $\pi$ rappresenta la quantità di moto dello spazio del compito e $\pi_\nu la quantità di moto dello spazio nulo. Si dimostra che l'energia cinetica si decompone in una somma di forme quadratiche dello spazio del compito e dello spazio nullo coinvolgenti l'inversa del tensore di mobilità esteso$\bar{\Lambda}$.

3. Formulazione del Sistema:

   • Il sistema risultante è un sistema port-Hamiltoniano (Equazione 27) con una matrice di interconnessione antisimmetrica $J_z$. Il sistema presenta due distinti porti di potenza: un porto del compito $(\sigma, \eta)$ e un porto dello spazio nullo $(\tau_0, \nu)$.
   • La matrice di interconnessione include termini fuori diagonale ($G_{12}$) che modellano esplicitamente l'accoppiamento energetico interno tra la dinamica dello spazio del compito e quella dello spazio nullo.

4. Progettazione del Controllo (IDA-PBC):

   • Gli autori applicano il framework di Controllo Basato sulla Passività con Assegnazione di Interconnessione e Smorzamento (IDA-PBC) al nuovo modello.
   • L'obiettivo del controllo è stabilizzare un equilibrio desiderato nello spazio del compito e modellare l'impedenza dello spazio del compito.
   • Le condizioni di adattamento (matching conditions) vengono risolte preservando la struttura dell'energia cinetica e introducendo un'energia potenziale modellata $V_c(q)$.
   • La legge di controllo risultante consiste in tre componenti: Modellazione dell'Energia (per definire l'equilibrio), Instradamento dell'Energia (per modificare le interconnessioni senza dissipare energia) e Iniezione di Smorzamento (per garantire la stabilità asintotica).

Contributi Chiave

• Nuovo Modello pH Geometrico: Il documento presenta la prima formulazione pH per manipolatori ridondanti che decompone rigorosamente quantità di moto e potenza in componenti dello spazio del compito e dello spazio nullo mediante una trasformazione di coordinate.
• Decomposizione Duale: Introduce una decomposizione duale dello spazio delle forze generalizzate che è fisicamente significativa e matematicamente coerente con la decomposizione delle velocità, utilizzando proiettori dinamicamente coerenti.
• Porti di Potenza Espliciti: Il modello identifica esplicitamente due coppie di porti coniugati dalla potenza: una per lo spazio del compito (che modella le interazioni esterne) e una per lo spazio nullo (che modella la dinamica della ridondanza interna).
• Modellazione dell'Impedenza tramite IDA-PBC: Gli autori dimostrano l'utilità del modello progettando un controllore IDA-PBC che stabilizza una configurazione dello spazio del compito e modella attivamente l'impedenza (rigidezza e smorzamento) al porto del compito.

Risultati
La metodologia proposta è stata validata tramite simulazioni su un robot Franka Emika Panda a 7 DOF che esegue un compito di posizione cartesiana a 3 DOF.

• Stabilità: È stato dimostrato che il sistema in anello chiuso è stabile, con l'Hamiltoniana totale $H_{cl}$ che rimane non crescente in assenza di perturbazioni esterne.
• Comportamento dell'Impedenza: Le simulazioni hanno dimostrato la capacità di modellare l'impedenza dello spazio del compito. Variando il termine dell'energia potenziale $V_c(q)$, gli autori hanno ottenuto diversi profili di rigidezza (morbido vs rigido) all'equilibrio.
• Gestione della Ridondanza: I risultati hanno confermato che il controllore può stabilizzare la posizione dello spazio del compito $x^*$ gestendo al contempo la dinamica dello spazio nullo. Diverse configurazioni articolari $q^*$ che portano allo stesso $x^*$ sono state stabilizzate con distinzioni nei comportamenti energetici dello spazio nullo, illustrando la capacità del controllore di gestire la ridondanza.
• Traiettorie Energetiche: I grafici di simulazione hanno mostrato l'evoluzione dell'energia dello spazio del compito ($\bar{K}_t$), dell'energia dello spazio nullo ($\bar{K}_\nu$) e dell'energia totale ($H_{cl}$), confermando le attese caratteristiche di scambio energetico e dissipazione.

Significato e Rivendicazioni
Gli autori affermano che questo lavoro fornisce una base teorica rigorosa per l'analisi e il controllo di manipolatori ridondanti all'interno del formalismo port-Hamiltoniano. Decomponendo il sistema in porti dello spazio del compito e dello spazio nullo, il modello facilita:

1. Analisi Basata sull'Energia: Semplifica l'analisi dei flussi di energia e delle proprietà di passività rispetto alle descrizioni lagrangiane tradizionali.
2. Controllo Modulare: Apre nuove possibilità per strategie di controllo dello spazio del compito che tengono conto esplicitamente della ridondanza, consentendo la modellazione indipendente dell'impedenza del compito e del comportamento dello spazio nullo.
3. Intuizione Strutturale: La formulazione rivela la natura geometrica dell'accoppiamento tra la dinamica dello spazio del compito e quella dello spazio nullo, che spesso è oscurata in altre formulazioni.

Il documento conclude che questa formulazione rappresenta un passo significativo verso lo sviluppo di strategie di controllo avanzate e consapevoli dell'energia per sistemi robotici ridondanti, in particolare per applicazioni che richiedono un controllo preciso dell'impedenza e un'interazione fisica sicura.