Actuator-Aware Inverse Kinematics with Joint-Limit Admissibility for Torque-Controlled Redundant Robots

Technische Samenvatting: Actuator-Bewuste Inverse Kinematica met Gewrichtslimiet-Admissibiliteit voor Torque-gestuurde Redundante Robots

Probleemstelling
Redundante robots beschikken over meer aangedreven gewrichten dan nodig is om een specifieke taakruimtebeweging te realiseren, wat extra vrijheidsgraden biedt om secundaire doelstellingen zoals het vermijden van gewrichtslimieten te vervullen. Echter, in architecturen met regeling op koppel (torque-controlled), is de inverse kinematische (IK) output niet de uiteindelijke besturingsinput, maar een referentie-snelheid die wordt aangeleverd aan een downstream controller op koppel-niveau (bijv. Virtual Decomposition Control). Bijgevolg garandeert het minimaliseren van enkel het kinematische residu niet noodzakelijkerwijs een goede gerealiseerde beweging. Als de gegenereerde gewrichtssnelheid-referentie incompatibel is met de dynamica van de downstream controller of de actuatorlimieten, kan het fysieke systeem erin falen de taak te volgen, met name nabij de gewrichtslimieten. Bestaande IK-methoden lossen redundantie vaak op basis van kinematische criteria (bijv. minimale norm, nulruimte-projectie) zonder expliciet rekening te houden met de compatibiliteit van de referentie met de specifieke koppel-regellus of de capaciteitsbeperkingen van de actuatoren.

Methodologie
Het artikel stelt een controller-compatibele IK-formulering voor die de vereiste gewrichtsniveausnelheden ($\dot{q}_r$) genereert via een convex kwadratisch programmeerprobleem (QP). De methode is ontworpen om te fungeren als een tussenlaag tussen een eindpunt-traject en de koppel-regellus van een redundante robot.

1. Controller-Compatibiliteitsobjectief: De QP minimaliseert een kostenfunctie die de taakbehoud en de controller-compatibiliteit in balans brengt. De weegmatrix ($W_c$) bevat:

   • Isotrope Baseline: Zorgt voor een goede conditionering.
   • Consistentie van de Vorige Commando ($W_\Delta$): Bestraft abrupte veranderingen in de vereiste snelheid ten opzichte van de vorige stap, wat de vloeiendheid bevordert.
   • Actuator Koppelcapaciteit-Weging ($W_\tau$): Bestraft het gebruik van gewrichten met een lagere koppelcapaciteit ten opzichte van het sterkste gewricht in het systeem. Deze weging is afgeleid van bekende actuatorlimieten, niet van gemeten koppel.

2. Gewrichtslimiet-Admissibiliteit: In plaats van harde beperkingen die de QP onhaalbaar zouden kunnen maken, gebruikt de methode Control Barrier Function (CBF)-achtige ongelijkheden om een admissibel stel van vereiste snelheden ($D_r(q)$) te definiëren. Deze grenzen waarborgen dat de gecommandeerde snelheid de gewrichten niet te snel richting hun mechanische limieten stuurt.

3. Zachte Taakrestrictie: Om gevallen te behandelen waarin de taakopdracht incompatibel is met de admissibele snelheidsverzameling, wordt de taakvergelijking ($J\dot{q}_r = V_r$) behandeld als een zachte restrictie. Het taakresidue wordt in de objectieve functie bestraft in plaats van het primaire minimalisatie-doel te zijn, waardoor de solver de mogelijkheid heeft om de prioriteit te geven aan controller-compatibiliteit wanneer dat nodig is.

Belangrijkste Bijdragen

• Formulering: Een nieuwe QP-gebaseerde IK-formulering die expliciet actuator-koppelcapaciteit en de consistentie van het vorige commando integreert in de redundantie-resolutie voor koppel-gestuurde robots.
• Referentie-niveau Veiligheid: De introductie van CBF-achtige grenzen op de vereiste snelheid (de IK-output) in plaats van de plant-input, wat gewrichtslimiet-admissibiliteit op referentie-niveau biedt zonder de downstream controller te wijzigen.
• Taak-Admissibiliteitsafweging: Een mechanisme om de balans te vinden tussen taakbehoud en controller-compatibiliteit door een slack-variabele voor de taakvergelijking te gebruiken, waardoor voorkomt dat het taakresidue de noodzaak voor haalbare, vloeiende referenties overrulet.

Experimentele Resultaten
De methode werd geëvalueerd op een 7-DoF bovenarm-exoskelet met behulp van een Virtual Decomposition Control (VDC) framework. Het werd vergeleken met vier baselines: Pseudoinvers (PINV), Damped Least-Squares (DLS), Null-Space Joint-Limit Avoidance (NS-JLA), en een Task-Preserving QP (TP-QP) die dezelfde admissibiliteitsrestricties gebruikt maar zonder het controller-compatibiliteitsobjectief.

• Gerealiseerde Prestaties: De voorgestelde methode behaalde de laagste Root Mean Square (RMS) positie- en oriëntatiefouten, evenals de laagste gerealiseerde taak-snelheidsresiduen, waarmee het alle baselines overtrof. Merkwaardig genoeg verminderde het de RMS-positiefout met 29,6% en de RMS-oriëntatiefout met 20,2% ten opzichte van de TP-QP baseline.
• Limietgedrag: De voorgestelde methode vertoonde een significant lagere "limit-pushing" index (commando's die beweging naar de limieten sturen), waarbij deze tot 96% werd verminderd vergeleken met andere methoden.
• Koppel-Efficiëntie: Het resulteerde in de laagste RMS-koppelnorm, wat duidt op een efficiënter gebruik van de actuatorbronnen.
• Admissibiliteit: De methode handhaafde nul overtredingen van de admissibele vereiste-snelheidsgrenzen, terwijl kinematische baselines (PINV, DLS, NS-JLA) deze grenzen regelmatig overschreden.

Betekenis en Claims
Het artikel claimt dat voor koppel-gestuurde redundante robots, IK niet louter de kinematische fout moet minimaliseren, maar ook de gewrichtsniveau-referenties moet genereren die compatibel zijn met de downstream controller en de capaciteiten van de actuatoren. De resultaten wijzen erop dat de voorgestelde formulering een superieur evenwicht bereikt tussen taakbehoud en admissibiliteit. Door referenties te genereren die de actuatorcapaciteiten respecteren en agressief "limit-pushing" vermijden, verbetert de methode het gerealiseerde taakgedrag zonder de bestaande koppel-regelaar te hoeven herontwerpen. De auteurs kaderen deze bevindingen bescheiden als "gewrichtslimiet-bewustzijn op referentieniveau" en "controller-compatibele redundantie-resolutie", in plaats van een formele bewijsvoering van plant-niveau veiligheid. Toekomstig werk wordt geïdentificeerd als het onderzoeken van gekoppelde IK–koppel-controle restrictie-formuleringen en formele closed-loop restrictie-analyse.