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

Sintesi Tecnica: Cinematica Inversa Sensibile agli Attuatori con Ammissibilità dei Limiti di Giunto per Robot Ridondanti a Controllo di Coppia

Problema
I robot ridondanti possiedono più giunti attuati di quelli necessari per raggiungere un determinato movimento nello spazio operativo, offrendo gradi di libertà supplementari per soddisfare obiettivi secondari come l'evitamento dei limiti di giunto. Tuttavia, nelle architetture a controllo di coppia, l'output della cinematica inversa (IK) non è l'input di controllo finale, ma una velocità di riferimento fornita a un controllore a valle del livello di coppia (ad esempio, il Virtual Decomposition Control). Di conseguenza, la minimizzazione del solo residuo cinematico non garantisce un movimento realizzato soddisfacente. Se il riferimento di velocità giunto generato è incompatibile con la dinamica del controllore a valle o con i limiti degli attuatori, il sistema fisico può fallire nel seguire il compito, specialmente in prossimità dei limiti di giunto. I metodi di IK esistenti spesso risolvono la ridondanza basandosi su criteri cinematici (ad esempio, norma minima, proiezione dello spazio nullo) senza tenere esplicitamente conto della compatibilità del riferimento con il loop di controllo specifico a livello di coppia o con i vincoli di capacità degli attuatori.

Metodologia
Il documento propone una formulazione di IK compatibile con il controllore che genera le velocità giunto richieste ($\dot{q}_r$) tramite un problema di programmazione quadratica (QP) convessa. Il metodo è progettato per funzionare come uno strato intermedio tra una traiettoria dell'endpoint e il controllore a livello di coppia di un robot ridondante.

1. Obiettivo di Compatibilità con il Controllore: Il QP minimizza una funzione di costo che bilancia la preservazione del compito con la compatibilità del controllore. La matrice di ponderazione ($W_c$) include:

   • Baseline Isotropica: Garantisce un buon condizionamento.
   • Consistenza del Comando Precedente ($W_\Delta$): Penalizza i cambiamenti bruschi nella velocità richiesta rispetto al passo precedente, promuovendo la fluidità.
   • Ponderazione della Capacità di Coppia dell'Attuatore ($W_\tau$): Penalizza l'uso di giunti con minore capacità di coppia rispetto al giunto più forte del sistema. Questa ponderazione è derivata dai limiti noti degli attuatori, non dalla coppia misurata.

2. Ammissibilità dei Limiti di Giunto: Inveve di utilizzare vincoli rigidi che potrebbero rendere il QP non ammissibile, il metodo impiega disuguaglianze di tipo Control Barrier Function (CBF) per definire un insieme ammissibile di velocità richieste ($D_r(q)$). Questi limiti assicurano che la velocità comandata non spinga il giunto troppo rapidamente verso i suoi limiti meccanici.

3. Vincolo di Compito Soft: Per gestire i casi in cui il comando del compito è incompatibile con l'insieme ammissibile delle velocità, l'equazione del compito ($J\dot{q}_r = V_r$) viene trattata come un vincolo soft utilizzando una variabile di slack ($s$). Il residuo del compito viene penalizzato nella funzione obiettivo piuttosto che essere il target primario di minimizzazione, permettendo al risolutore di dare priorità alla compatibilità del controllore quando necessario.

Contributi Chiave

• Formulazione: Una nuova formulazione di IK basata su QP che incorpora esplicitamente la capacità di coppia dell'attuatore e la consistenza del comando precedente nella risoluzione della ridondanza per robot a controllo di coppia.
• Sicurezza a Livello di Riferimento: L'introduzione di limiti di tipo CBF sulle velocità richieste (l'output dell'IK) piuttosto che sull'input della pianta, fornendo ammissibilità dei limiti di giunto a livello di riferimento senza modificare il controllore a valle.
• Compromesso di Ammissibilità del Compito: Un meccanismo per bilanciare la preservazione del compito e la compatibilità del controllore utilizzando una variabile di slack per l'equazione del compito, impedendo al residuo del compito di sovrastare la necessità di riferimenti fattibili e fluidi.

Risultati Sperimentali
Il metodo è stato valutato su un esoscheletro per l'arto superiore a 7 DoF utilizzando un framework di Virtual Decomposition Control (VDC). È stato confrontato con quattro baseline: Pseudoinversa (PINV), Damped Least-Squares (DLS), Null-Space Joint-Limit Avoidance (NS-JLA) e un QP di Preservazione del Compito (TP-QP) che utilizza gli stessi vincoli di ammissibilità ma manca dell'obiettivo di compatibilità del controllore.

• Prestazioni Realizzate: Il metodo proposto ha ottenuto l'errore RMS più basso per posizione e orientamento, così come il più basso residuo di velocità del compito realizzato, superando tutte le baseline. In particolare, ha ridotto l'errore RMS di posizione del 29,6% e l'errore RMS di orientamento del 20,2% rispetto alla baseline TP-QP.
• Comportamento ai Limiti: Il metodo proposto ha dimostrato un indice di "spinta ai limiti" (comandi che dirigono il movimento verso i limiti) significativamente più basso, riducendolo fino al 96% rispetto agli altri metodi.
• Efficienza di Coppia: Ha prodotto la norma di coppia RMS più bassa, suggerendo un uso più efficiente delle risorse degli attuatori.
• Ammissibilità: Il metodo ha mantenuto zero violazioni dei limiti di velocità richiesta ammissibile, mentre le baseline cinematiche (PINV, DLS, NS-JLA) hanno frequentemente superato tali limiti.

Significatività e Rivendicazioni
Il documento sostiene che, per i robot ridondanti a controllo di coppia, l'IK non debba semplicemente minimizzare l'errore cinematico, ma debba generare riferimenti a livello di giunto che siano compatibili con il controllore a valle e con le capacità degli attuatori. I risultati indicano che la formulazione proposta raggiunge un equilibrio superiore tra preservazione del compito e ammissibilità. Generando riferimenti che rispettano le capacità degli attuatori ed evitano spinte aggressive verso i limiti, il metodo migliora il comportamento reale del compito senza richiedere una riprogettazione del controllore a livello di coppia esistente. Gli autori inquadrano moderatamente queste scoperte come "consapevolezza dei limiti di giunto a livello di riferimento" e "risoluzione della ridondanza compatibile con il controllore", piuttosto che come una prova formale di sicurezza a livello di pianta. Il lavoro futuro è identificato nella ricerca di formulazioni di vincolo accoppiate IK-controllo di coppia e nell'analisi dei vincoli a ciclo chiuso.