Gravity Compensation of the dVRK-Si Patient Side Manipulator based on Dynamic Model Identification

Technische Samenvatting: Zwaartekrachtcompensatie van de dVRK-Si Patient Side Manipulator op basis van Dynamische Modelidentificatie

Probleemstelling
De da Vinci Research Kit (dVRK) is een cruciaal open-source platform voor het bevorderen van onderzoek in robotgestuurde chirurgie. Terwijl het oorspronkelijke dVRK Classic-systeem gebruikmaakte van een Patient Side Manipulator (PSM) waarbij zwaartecrachteffecten verwaarloosbaar waren, beschikt het nieuwere dVRK-Si systeem, afgeleid van het da Vinci Si Surgical System, over een structureel verbeterde PSM. Deze structurele wijziging resulteert in een significante zwaartekrachtoffset die niet langer genegeerd kan worden. Ongecompenseerde zwaartekracht in de dVRK-Si PSM leidt tot verminderde controleprecisie en langere responstijden. Hoewel dynamische modelidentificatie is behandeld voor de dVRK Classic, vereisen de mechanische verschillen van de dVRK-Si nieuw onderzoek naar modelgebaseerde regeling om verbeterde prestaties te bereiken.

Methodologie
De auteurs stellen een uitgebreide aanpak voor voor zwaartekrachtcompensatie (GC) voor de dVRK-Si PSM, gecentreerd rond het identificeren van de volledige dynamische modelparameters en het isoleren van de zwaartekrachtterm, $G(q)$, voor compensatie. De methodologie verloopt via vijf afzonderlijke stappen:

1. Kinematische Modellering: Een volledig kinematisch model van de dVRK-Si PSM werd geconstrueerd op basis van fabrikant-specificaties en fysieke metingen. Dit model maakt gebruik van aangepaste Denavit-Hartenberg (DH) parameters (gedetailleerd in Tabel I) en definieert een specifieke frame-structuur (Fig. 2) om de complexe verbinding van de Si PSM te verklaren, inclusief het Remote Center of Motion (RCM).
2. Dynamische Modellering: Het dynamische model werd afgeleid met behulp van de Euler-Lagrange benadering. De bewegingsvergelijkingen worden uitgedrukt als $M(q)\ddot{q} + C(q, \dot{q})\dot{q} + G(q) = \tau$, waarbij het doel is om de parametervector $\delta$ te identificeren die de traagheid van de schakels, motor-traagheid, wrijving en stijfheid vertegenwoordigt.
3. Ontwerp van Excitatie-trajecten: Een optimaal excitatie-traject werd berekend op basis van gewrichtsrestricties en het dynamische model om rijke gegevensverzameling voor parameteridentificatie te waarborgen.
4. Gegevensverzameling: Het excitatie-traject werd uitgevoerd op de fysieke dVRK-Si PSM om kinematische en dynamische gegevens te verzamelen.
5. Parameteridentificatie: De dynamische parameters werden opgelost met behulp van een convexe optimalisatiebenadering. Om overfitting te voorkomen en fysieke validiteit te garanderen, incorporeerde de optimalisatie specifieke restricties: schakelmassa's moeten positief zijn, zwaartepunten moeten binnen de convexe omhullende van de schakel blijven, en wrijvingscoëfficiënten, motor-traagheid en veerstijfheid moeten positief zijn.

Belangrijkste Bijdragen
Het artikel presenteert twee primaire bijdragen:

• Een nieuw volledig kinematisch model van de dVRK-Si PSM, dat expliciet de frame-relaties en parameters definieert die nodig zijn voor nauwkeurige modellering.
• Een zwaartekrachtcompensatiestrategie gebaseerd op dynamische modelidentificatie. Door het volledige dynamische model te identificeren, extraheren de auteurs de $G(q)$-term om het benodigde koppel voor zwaartekrachtcompensatie te leveren, in plaats van te vertrouwen op heuristische of vereenvoudigde modellen.

Resultaten
De effectiviteit van de voorgestelde zwaartekrachtcompensatie werd gevalideerd via een drift-test. In dit experiment werd de PSM naar een gewenste pose bewogen met behulp van een standaard PD-positiecontroller, waarna er werd overgeschakeld naar een open-loop koppelgebaseerde zwaartekrachtcompensatiemodus voor 5 seconden. Drift werd gedefinieerd als beweging die 1 graad of 1 mm overschreed.

• Driftprestaties: Het systeem behield de pose van de robot zonder merkbare drift over vijf willekeurige testconfiguraties.
• Foutreductie: De zwaartekrachtcompensatie-aanpak vertoonde kleinere stationaire fouten vergeleken met de PD-controller alleen.
• Koppelanalyse: De gewrichtskoppels gegenereerd door de GC-methode voor de eerste drie gewrichten (die het meest door zwaartekracht worden beïnvloed) vielen binnen de berekende onderste en bovenste grenzen die vereist zijn om de gewrichten in positie te houden tegen statische wrijving. In de meeste gevallen lagen deze koppels dicht bij het middelpunt van het haalbare bereik.
• Observaties Gewricht 3: Voor het derde gewricht (een prismatisch gewricht) werd een afwijking van het koppelmiddelpunt waargenomen, wat de auteurs toeschrijven aan significante wrijving in het prismatische gewricht en de cannula.

Betekenis en Claims
De auteurs claimen dat de voorgestelde zwaartekrachtcompensatie-aanpak effectief de pose van de dVRK-Si PSM behoudt zonder merkbare drift, waarmee een kritieke beperking van de structurele upgrade van het systeem wordt aangepakt. De studie toont aan dat modelgebaseerde identificatie succesvol kan generaliseren over verschillende dVRK-Si PSM's, mits zij dezelfde montagehoek-configuratie delen. Door nauwkeurige zwaartekrachtcompensatie mogelijk te maken, faciliteert dit werk een hogere controleprecisie en snellere responstijden, waardoor geavanceerdere onderzoek en controletoepassingen voor het dVRK-Si platform worden ondersteund. Het werk claimt niet alle dynamische controleuitdagingen op te lossen, maar richt zich specifiek op de zwaartekrachtoffset die inherent is aan het Si PSM-ontwerp.