Impedance MPC for Physical Human-Robot Interaction: Predictive Disturbance Rejection with Joint-Limit Safety

Technische Samenvatting: Impedantie MPC voor Fysieke Mens–Robot Interactie

Probleemstelling
Fysieke mens–robot interactie (pHRI) vereist dat robots tegelijkertijd een hoge trajectnauwkeurigheid handhaven en een compliant veiligheid garanderen tijdens onvoorziene contactmomenten. Klassieke impedantieregeling, hoewel effectief voor veiligheid, lijdt onder een fundamentele structurele beperking: onder een aanhoudende menselijke kracht ($F_h$) vertoont het een niet-nul stationaire positiefout gedefinieerd door $e_\infty = K_d^{-1}F_h$. Bijvoorbeeld, een duw van 15 N tegen een stijfheid van 300 N/m resulteert in een afwijking van 50 mm. Hoewel het verhogen van de stijfheid ($K_d$) deze fout vermindert, schendt dit de veiligheidsrestricties door de contactkrachten te verhogen. Omgekeerd wordt het toevoegen van een integraal deel om de stationaire fout te elimineren ernstig beperkt door stabiliteitseisen, wat de convergentiesnelheid beperkt. Bestaande Model Predictive Control (MPC) benaderingen voor pHRI behouden vaak de volledige nietlineaire plantdynamica, wat de regelsnelheden beperkt, of falen in het bieden van formele garanties voor een nul stationaire fout onder persistente verstoringen.

Methodologie
De auteurs stellen een tweelagige Impedantie MPC architectuur voor, ontworpen om de spanning tussen trajectnauwkeurigheid en compliant veiligheid op te lossen.

• Laag 1: Analytische Nietlineaire Inversie
  De eerste laag maakt gebruik van een feedforward-regelstrategie gebaseerd op operational-space decompositie. Het heft analytisch zwaartekracht, Coriolis- en taakruimte-traagheidstermen op. Dit transformeert de resterende plantdynamica naar een configuratie-onafhankelijke lineaire dubbele integrator.

  • De foutdynamica wordt gereduceerd tot $\ddot{e} = -\Lambda^{-1}(q) F_{mpc} + d(t)$, waarbij $d(t)$ geaggregeerde verstoringen vertegenwoordigt (menselijke kracht, wrijving, modelonzekerheden).
  • Cruciaal is dat deze linearisatie resulteert in een constante toestands-transitiematrix ($A_d$) voor het discrete-time systeem, ongeacht de configuratie van de robot. Dit maakt het mogelijk om de "vrije respons"-matrix eenmalig vooraf te berekenen, wat de online computationele belasting aanzienlijk vermindert.

• Laag 2: Convexe QP met Verstoring-augmentatie
  De tweede laag lost een receding-horizon optimalisatieprobleem op bij 100 Hz (met een 1 kHz inner loop voor feedforward-updates).

  • Verstoring-schatting: Een augmented Kalman filter schat een persistente verstoringstoestand ($\hat{d}$) die gemodelleerd wordt als een random walk. Deze toestand wordt geïntegreerd in het MPC-voorspellingsmodel, wat mogelijk maakt dat er offset-vrije tracking (nul stationaire fout) wordt bereikt voor constante of asymptotisch constante verstoringen.
  • Optimalisatie: De controller lost een convexe Kwadratische Programmatie (QP) op met 30 variabelen op, onderworpen aan box-constraints op de controlekracht ($F_{mpc}$). De kostenfunctie minimaliseert de trajectfout over een horizon, terwijl gewrichtslimieten worden gerespecteerd.
  • Veiligheidsmechanismen: Veiligheid met betrekking tot gewrichtslimieten wordt afgedwongen via een dual-barrier aanpak: een null-space inverse-barrier potentiaal en een taakruimte werkruimte-projectie. Deze mechanismen voorkomen schendingen van gewrichtslimieten zonder de taaktracking in veilige regio's te verslechteren.

Belangrijkste Bijdragen

1. Tweelagige Constant-$A_d$ Architectuur: Door nietlineariteiten analytisch op te heffen, reduceren de auteurs de plant tot een lineair tijdvariant systeem met een constante matrix. Dit maakt het mogelijk om een 30-variabele QP in minder dan 1 ms op te lossen, wat real-time implementatie haalbaar maakt.
2. Analytische Verbinding met Klassieke Impedantie: De paper bewijst (Theorema 1) dat in de onbeperkte, verstoringvrije limiet, de voorgestelde MPC wiskundig equivalent is aan een klassieke taakruimte impedantieregeling. De gerealiseerde stijfheid en demping worden bepaald door de LQR-gains afgeleid van de kosten-gewichten. Dit positioneert de methode als een uitbreiding van klassieke impedantie die constraint-afhandeling en offset-vrije afwijzing toevoegt, in plaats van een vervanging.
3. Formele Garantie van Nul Stationaire Fout: Door Kalman-verstoring-augmentatie bereikt het systeem een op het Internal Model Principle gebaseerde garantie van nul stationaire fout voor persistente verstoringen, waarmee de eerdere offset-vrije MPC-theorie wordt uitgebreid naar koppelgestuurde manipulatoren.
4. Dual-Barrier Gewrichtslimiet Veiligheid: De integratie van null-space potentialen en werkruimte-projecties voorkomt empirisch schendingen van gewrichtslimieten over de geteste werkruimte, inclusief boundary stress tests.

Experimentele Resultaten
Experimenten werden uitgevoerd op een 7-DOF Franka FR3 robot met behulp van MuJoCo simulatie. De voorgestelde methode (Impedance MPC met Kalman-augmentatie) werd vergeleken met klassieke impedantie, admittance control en PI impedantie.

• Stationaire Fout: Onder een aanhoudende kracht van 15 N bereikte de voorgestelde methode een stationaire fout van <0,05 mm, vergeleken met 44,8 mm voor klassieke impedantie (een reductie van meer dan 800 keer).
• Transiënt Gedrag: Bij circulaire traject-tracking verminderde de MPC alleen (zonder Kalman) de RMS-fout in het contactvenster met 19× ten opzichte van klassieke impedantie. De toevoeging van het Kalman filter elimineerde de stationaire fout volledig.
• Robuustheid: Het systeem vertoonde een gracieuze robuustheid tegen meetruis (stationaire fout bleef <1 mm zelfs met 5 mm ruis) en inertie-model mismatch (tracking RMSE bleef invariant tot 30% inertiefout wanneer het Kalman filter actief was).
• Veiligheid: In boundary tests waar klassieke impedantie gewrichtslimieten overschreed, behield de MPC een veilige marge (minimale gewrichtsmarge van 0,084 versus 0,048 voor impedantie).

Betekenis en Claims
De paper claimt dat de voorgestelde architectuur succesvol de concurrerende eisen van pHRI verenigt: hoge precisie in traject-tracking en compliant veiligheid. De primaire betekenis ligt in het structurele inzicht dat analytische feedforward-annulering een constante lineaire structuur mogelijk maakt, wat op zijn beurt toelaat:

1. Precomputatie: De vrije respons-matrix wordt eenmalig berekend, waardoor de QP-complexiteit wordt ontkoppeld van de configuratie van de robot.
2. Formele Garanties: De lineaire structuur maakt rigoureuze bewijzen van impedantie-equivalentie en offset-vrije tracking mogelijk.
3. Real-time Haalbaarheid: De aanpak bereikt hoge regelsnelheden (100 Hz QP, 1 kHz feedforward) op standaard hardware, waarmee de computationele knelpunten van eerdere nietlineaire MPC-benaderingen worden overwonnen.

De auteurs concluderen dat deze methode een robuuste, theoretisch gefundeerde oplossing biedt voor pHRI die de inherente stationaire fout van klassieke impedantieregeling elimineert terwijl veiligheidsrestricties worden gehandhaafd; toekomstig werk zal gericht zijn op validatie op fysieke hardware en energie-tank passiviteit-augmentatie.