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

Technische Samenvatting: Een Geometrische Taakruimte Port-Hamiltoniaanse Formulering voor Redundante Manipulatoren

Probleemstelling
Redundante manipulatoren, die over meer vrijheidsgraden (DOF) beschikken dan vereist voor een specifieke differentiële kinematische taak, vormen een uitdaging voor modellering en besturing. Hoewel Lagrangiaanse formuleringen voor redundantie goed gevestigd zijn in de literatuur (bijv. Dietrich et al., 2015; Ott et al., 2015), is er behoefte aan een rigoureus geometrisch kader binnen de Port-Hamiltoniaanse (pH) formalisme dat de decompositie van energie en vermogen tussen de taakruimte en de nulruimte expliciet afhandelt. Bestaande pH-benaderingen voor taakruimte-impedantievorming (bijv. Scherpen et al., 2025) richten zich vaak op niet-redundante systemen of benutten de structurele eigenschappen van redundantie niet volledig. Het kernprobleem dat wordt aangepakt, is het gebrek aan een pH-model dat de momentum- en vermogenspoorten van het systeem op natuurlijke wijze deelt in taakruimte- en nulruimtecomponenten, wat de analyse en besturing op basis van energie faciliteert voor redundante systemen.

Methodologie
De auteurs stellen een nieuwe geometrische pH-formulering voor, afgeleid van een coördinatentransformatie van de standaard Hamiltoniaanse dynamica. De methodologie verloopt via de volgende stappen:

1. Geometrische Decompositie:

   • Snelheidsruimte: Met behulp van de inertiemetriek $M(q)$ wordt de raumtocht $T_qQ$ gedecomposeerd in de kern van de taak-Jacobiaan $J(q)$ (nulruimte) en haar $M$-orthogonale complement. Dit maakt het mogelijk om de gezamenlijke snelheid $\dot{q}$ uniek te splitsen in een taakruimtecomponent $v$ en een nulruimtecomponent $\nu$.
   • Krachtruimte: Een duale decompositie wordt toegepast op de gegeneraliseerde krachtruimte $T^*_qQ$. Het koppel $\tau$ wordt gedecomposeerd in een component $\tau_F$ in het beeld van $J^\top$ (taakruimtekrachten) en een component $\tau_0$ in de annihilator van de taakruimte-snelheidssubruimte (nulruimtekrachten).
   • Vermogensbalans: Deze decompositie laat zien dat het mechanische vermogen $\tau^\top \dot{q}$ uiteenvalt in twee onafhankelijke termen: $\tau_F^\top v$ (taakvermogen) en $\tau_0^\top \nu$ (nulruimtevermogen).

2. Coördinatentransformatie:

   • Om deze decompositie in de pH-structuur in te bedden, definiëren de auteurs een uitgebreide taaksnelheid $\eta_e = \bar{J}(q)\dot{q}$, waarbij $\bar{J}$ de taak-Jacobiaan $J$ en een nulruimte-basismatrix $N$ combineert.
   • Een coördinatentransformatie $\Phi$ wordt toegepast op de standaard Hamiltoniaanse toestand $(q, p)$, waarbij de impuls $p$ wordt getransformeerd naar een uitgebreide impuls $\pi_e = \bar{J}^{-\top}(q)p$.
   • Deze transformatie levert een nieuwe toestandsvector op $z = (q, \pi, \pi_\nu)$, waarbij $\pi$ de taakruimte-impuls vertegenwoordigt en $\pi_\nu$ de nulruimte-impuls. De kinetische energie wordt getoond te kunnen worden gedecomposeerd in een som van taakruimte- en nulruimte-kwadratische vormen die de inverse van de uitgebreide mobiliteitstensor $\bar{\Lambda}$ bevatten.

3. Systeemformulering:

   • Het resulterende systeem is een port-Hamiltoniaans systeem (Vergelijking 27) met een spai-symmetrische interconnectiematrix $J_z$. Het systeem beschikt over twee onderscheidende vermogenspoorten: een taakpoort $(\sigma, \eta)$ en een nulruimtepoort $(\tau_0, \nu)$.
   • De interconnectiematrix bevat off-diagonaal termen ($G_{12}$) die de interne energiekoppeling tussen de taak- en nulruimtedynamica expliciet modelleren.

4. Besturing (IDA-PBC):

   • De auteurs passen het Interconnection and Damping Assignment Passivity-Based Control (IDA-PBC) kader toe op het nieuwe model.
   • Het besturingsdoel is het stabiliseren van een gewenste taakruimte-evenwichtstoestand $x^*$ en het vormen van de taakruimte-impedantie.
   • De matching-condities worden opgelost door de kinetische energiestructuur te behouden en een gevormde potentiële energie $V_c(q)$ te introduceren.
   • De resulterende besturingswet bestaat uit drie componenten: Energievorming (om het evenwicht te definiëren), Energie-routing (om interconnecties te wijzigen zonder energie te dissiperen) en Dempingsinjectie (om asymptotische stabiliteit te garanderen).

Belangrijkste Bijdragen

• Nieuw Geometrisch pH-Model: Het artikel presenteert de eerste pH-formulering voor redundante manipulatoren die de impuls en het vermogen rigoureus decomponeert in taakruimte- en nulruimtecomponenten middels een coördinatentransformatie.
• Duale Decompositie: Het introduceert een duale decompositie van de gegeneraliseerde krachtruimte die fysiek betekenisvol is en wiskundig consistent met de snelheidsdecompositie, gebruikmakend van dynamisch consistente projectoren.
• Expliciete Vermogenspoorten: Het model identificeert expliciet twee vermogens-geconjugeerde poorten: één voor de taakruimte (modellering van externe interacties) en één voor de nulruimte (modellering van interne redundantiedynamica).
• Impedantievorming via IDA-PBC: De auteurs demonstreren het nut van het model door een IDA-PBC-controller te ontwerpen die een taakruimte-configuratie stabiliseert en de impedantie (stijfheid en demping) aan de taakpoort actief vormt.

Resultaten
De voorgestelde methodologie werd gevalideerd via simulaties op een 7-DOF Franka Emika Panda robot die een 3-DOF Cartesiaanse positie-taak uitvoert.

• Stabiliteit: Er is aangetoond dat het gesloten lus systeem stabiel is, waarbij de totale Hamiltonian $H_{cl}$ niet-toenemend blijft in de afwezigheid van externe perturbaties.
• Impedantiegedrag: De simulaties toonden het vermogen aan om de taakruimte-impedantie te vormen. Door de potentiële energieterm $V_c(q)$ te variëren, bereikten de auteurs verschillende stijfheidsprofielen (zacht versus stijf) bij het evenwicht.
• Redundantiebehandeling: De resultaten bevestigden dat de controller in staat is de taakruimte-positie $x^*$ te stabiliseren terwijl de nulruimtedynamica wordt beheerd. Verschillende gewrichtsconfiguraties $q^*$ die leiden tot dezelfde $x^*$ werden succesvol gestabiliseerd met verschillende nulruimte-energiegedragingen, wat het vermogen van de controller illustreert om met redundantie om te gaan.
• Energietrajecten: De simulatieplots toonden de evolutie van de taakruimte-energie ($\bar{K}_t$), de nulruimte-energie ($\bar{K}_\nu$) en de totale energie ($H_{cl}$), wat de verwachte energie-uitwisseling en dissipatiekenmerken bevestigt.

Betekenis en Claims
De auteurs claimen dat dit werk een rigoureus theoretisch fundament biedt voor het analyseren en besturen van redundante manipulatoren binnen het port-Hamiltoniaanse kader. Door het systeem te deconstrueren in taakruimte- en nulruimtepoorten, faciliteert het model:

1. Energie-gebaseerde Analyse: Het vereenvoudigt de analyse van energiestromen en passiviteitseigenschappen vergeleken met traditionele Lagrangiaanse beschrijvingen.
2. Modulaire Besturing: Het opent nieuwe mogelijkheden voor taakruimte-besturingsstrategieën die expliciet rekening houden met redundantie, waardoor onafhankelijke vormgeving van taakimpedantie en nulruimtegedrag mogelijk wordt.
3. Structureel Inzicht: De formulering onthult de geometrische aard van de koppeling tussen de taak- en nulruimtedynamica, die in andere formuleringen vaak verborgen blijft.

Het artikel concludeert dat deze formulering een belangrijke stap is naar de ontwikkeling van geavanceerde, energie-bewuste besturingsstrategieën voor redundante robotische systemen, met name voor toepassingen die een precieze impedantiebesturing en veilige fysieke interactie vereisen.