Technische Samenvatting: Intentie-assimilatiecontrole voor nauwkeurige tracking met variabele impedantie in teleoperatie

1. Probleemstelling

Teleoperatiesystemen vertrouwen doorgaans op een veerachtige kracht om een volger-robot naar de positie van een leider te trekken. Deze traditionele aanpak presenteert een fundamentele afweging:

• Lage stijfheid: Zorgt voor veiligheid bij interactie met delicate objecten of mensen, maar resulteert in slechte trackingnauwkeurigheid, vooral tijdens dynamische bewegingen.
• Hoge stijfheid: Zorgt voor nauwkeurige tracking, maar vormt veiligheidsrisico's in gedeelde omgevingen en kan instabiliteit of "whiplash"-effecten veroorzaken wanneer de operator de impedantie snel verandert.

Bestaande state-of-the-art oplossingen, zoals Tele-Impedantiecontrole (TIC), proberen dit op te lossen door de impedantie van de arm van de operator te schatten (via EMG of grijpkracht) en de impedantie van de volger hierop af te stemmen. TIC zendt echter nog steeds de huidige positie van de leider als doelwit. Bijgevolg kan de volger, als zijn impedantie laag is (compliant), de baan van de leider niet nauwkeurig volgen tenzij de operator een hoge fysieke stijfheid handhaaft (co-contractie), wat vermoeiend en onhoudbaar is. Omgekeerd riskeert een stijve volger schade aan de omgeving.

Het kernprobleem dat wordt aangepakt, is hoe een volger-robot in staat te stellen de beweging van een leider nauwkeurig te volgen, terwijl de operator de impedantie van de volger vrij kan moduleren van laag naar hoog, zonder de trackingprestaties of veiligheid te compromitteren.

2. Methodologie: Intentie-assimilatiecontrole (IAC)

De auteurs stellen Intentie-assimilatiecontrole (IAC) voor, een strategie die trackingnauwkeurigheid ontkoppelt van de momentane impedantie van de volger.

Kernconcept

In tegenstelling tot traditionele methoden die de huidige positie ($x_l$) van de leider naar de volger zenden, schat IAC de doelpositie ($\tau_l$) van de leider op basis van de door de operator uitgeoefende kracht en zendt deze geschatte doelstelling naar de volger. De volger volgt dan dit virtuele doel ($\tau^*$) in plaats van de momentane toestand van de leider.

Controlearchitectuur

1. Doelschatting: De volger schat de beoogde baan van de operator ($\tau^*$) door de kracht te observeren die op de leider-robot wordt uitgeoefend. Dit wordt gemodelleerd met een intern model waarbij de doelbaan een functie is van tijd (bijvoorbeeld een vaste positie of lineaire snelheid).
2. Staatobservatie: Een Kalman-filter wordt ingezet om de uitgebreide toestandsvector te schatten, die de positie en snelheid van de robot, de parameters van de doelbaan en de besturingsinput van de leider bevat. De waarnemer minimaliseert de fout tussen de geschatte staat en de gemeten staat (positie, snelheid en kracht).
3. Controlewet: De controller van de volger is ontworpen als:
   $$u = -L_1(x - \tau^*) - L_2(\dot{x} - \dot{\tau}^*)$$
   Waar $L_1$ en $L_2$ de stijfheids- en dempingswinsten van de volger zijn. Omdat het doel $\tau^*$ een schatting is van de bedoelde baan in plaats van de huidige positie, hoeven de winsten $L_1$ en $L_2$ niet hoog te zijn om convergentie te bereiken. Ze kunnen laag worden ingesteld voor veiligheid of dynamisch worden gemoduleerd.
4. Impedantiemodulatie: De operator controleert de grootte van de impedantie van de volger via zijn krachtgrijpkracht, die lineair correleert met de stijfheid van het armuiteinde. Dit maakt real-time aanpassing van de compliantie van de volger mogelijk.
5. Stabiliteit: Om instabiliteit te voorkomen bij het snel verhogen van de stijfheid (een bekend probleem in impedantiecontrole), wordt de snelheid van stijfheidsverhoging beperkt met een voorwaarde afgeleid van Kronander en Billard (2016), zodat het systeem stabiel blijft zelfs tijdens snelle overgangen.

Systeemdynamica

Het artikel modelleert de leider- en volgerrobots met standaard dynamica van stijve lichamen. De controller van de volger compenseert voor zijn eigen dynamica om de dynamica van de leider te matchen, wat effectief een "gematcht" systeem creëert waarbij de volger het gedrag van de leider nabootst als de besturingsinput identiek is.

3. Belangrijkste bijdragen

• Nieuwe controlestrategie: Introductie van IAC, die het controleparadigma verschuift van het volgen van de huidige positie van de leider naar het volgen van een geschatte doelpositie afgeleid van de intentie van de operator.
• Ontkoppeling van nauwkeurigheid en impedantie: Aantonen dat hoge trackingnauwkeurigheid kan worden behouden zelfs wanneer de impedantie van de volger laag is, waarmee de beperkingen van TIC worden overwonnen.
• Experimentele validatie: Een uitgebreide vergelijking tussen IAC en TIC in vier verschillende experimentele scenario's:
  1. Vrije tracking: Multi-assenbeweging met variabele impedantie.
  2. Zachte interactie: Interactie met een ballon om veiligheid en compliantie te testen.
  3. Peg-in-Hole: Een precisietask die hoge compliantie vereist voor uitlijning maar nauwkeurige tracking voor insertie.
  4. Bilateraal polijsten: Krachtfeedback-taak waarbij de operator de impedantie moduleert via grijpkracht.

4. Experimentele resultaten

De studie gebruikte twee 7-DOF Franka Emika-manipulatoren met een communicatieretardatie van 100 ms voor unilaterale taken en 0 ms voor bilaterale taken.

• Vrije tracking:

  • TIC: De trackingfout steeg scherp wanneer de impedantie daalde onder 400 N/m. Bij lage stijfheid (80 N/m) overschreden de fouten 20 cm. Hoge stijfheid veroorzaakte "whiplash" (snelle versnelling/vertraging) wanneer de operator de impedantie verhoogde.
  • IAC: Hield de trackingfout onder de 10 cm (rond de 5 cm) over het volledige impedantiebereik (80–1320 N/m). Er werd geen whiplash waargenomen.
  • Kwantitatief: IAC verlaagde de trackingfout met een factor 2,21 ten opzichte van TIC over het geteste bereik.

• Balloninteractie:

  • TIC: Zelfs met een hoge winst (300 N/m) slaagde de volger er niet in nauwkeurig te volgen in vrije ruimte en scheurde de ballon bij contact door slechte compliantiecontrole.
  • IAC: Met een lage winst (60 N/m) volgde de volger de leider nauwkeurig in vrije ruimte en interacteerde hij zachtjes met de ballon, waardoor scheuren werd voorkomen.

• Peg-in-Hole:

  • Deelnemers: 8 onervaren gebruikers.
  • Succespercentage: IAC behaalde een succespercentage van 88% binnen 20 seconden, vergeleken met 50% voor TIC ($p=0,02$).
  • Voltooiingstijd: Succesvolle proeven met IAC duurden aanzienlijk minder tijd (10,0 s versus 17,0 s voor TIC, $p<0,001$).
  • Mechanisme: De verbetering werd voornamelijk gedreven door de insertiefase. IAC maakte het mogelijk dat de oriëntatie van de volger correct reageerde op de rotatieaanpassingen van de leider, waardoor gebruikers de peg uit klemmen konden "wrikken". TIC slaagde er niet in deze rotatiecorrecties effectief door te geven wanneer de volger compliant was.

• Bilateraal polijsten:

  • IAC hield de trackingfout op het x-y-vlak laag, zelfs wanneer de operator de impedantie moduleerde via grijpkracht.
  • Krachtfeedback werd in beide modaliteiten nauwkeurig weerspiegeld aan de leider, wat stabiele bilaterale bediening bevestigt.

5. Betekenis en claims

Het artikel beweert dat IAC een ongekend niveau van controle biedt over de positie en impedantie van de volger tijdens zowel unilaterale als bilaterale teleoperatie.

• Veiligheid en nauwkeurigheid: IAC lost de traditionele afweging op en maakt veilige, lage-stijfheidsinteracties mogelijk zonder in te leveren op trackingnauwkeurigheid.
• Vrijheid voor de gebruiker: Operators kunnen de impedantie moduleren op basis van taakeisen (bijvoorbeeld lage stijfheid voor polijsten, hoge voor boren) zonder fysiek spieren te moeten co-contracteren om nauwkeurigheid te behouden.
• Robuustheid: De methode is robuust tegen communicatieretardaties (getest op 100 ms) en vereist geen complexe passiviteitsalgoritmen voor stabiliteit in de geteste configuraties.
• Praktijktoepasbaarheid: Door gebruik te maken van krachtgrijpkracht om impedantie te schatten, vermijdt het systeem de ruis en kalibratieproblemen die geassocieerd worden met EMG-gebaseerde methoden, waardoor het praktischer is voor implementatie in de echte wereld.

De auteurs concluderen dat IAC robots in staat stelt menselijke bewegingen nauwkeurig te repliceren, terwijl het de gebruiker de vrijheid geeft de impedantie aan te passen aan de omgeving, een vermogen dat TIC niet kan bereiken zonder ofwel veiligheid ofwel prestaties te compromitteren.