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

Resumen Técnico: Cinemática Inversa Consciente de los Actuadores con Admisibilidad de Límites de Articulación para Robots Redundantes con Control de Par

Planteamiento del Problema
Los robots redundantes poseen más articulaciones actuadas de las necesarias para lograr un movimiento específico en el espacio de la tarea, ofreciendo grados de libertad adicionales para satisfacer objetivos secundarios como la evitación de límites de articulación. Sin embargo, en arquitecturas de control de par, la salida de la cinemática inversa (CI) no es la entrada de control final, sino una referencia de velocidad suministrada a un controlador de nivel de par descendente (por ejemplo, Control de Descomposición Virtual). Por consiguiente, minimizar únicamente el residuo cinemático no garantiza un buen movimiento realizado. Si la referencia de velocidad articular generada es incompatible con la dinámica del controlador de par o con los límites de los actuadores, el sistema físico puede fallar en el seguimiento de la tarea, particularmente cerca de los límites de las articulaciones. Los métodos de CI existentes suelen resolver la redundancia basándose en criterios cinemáticos (por ejemplo, norma mínima, proyección del espacio nulo) sin considerar explícitamente la compatibilidad de la referencia con el bucle de control de par específico o las restricciones de capacidad del actuador.

Metodología
El artículo propone una formulación de CI compatible con el controlador que genera las velocidades requeridas a nivel de articulación ($\dot{q}_r$) mediante un problema de programación cuadrática (QP) convexa. El método está diseñado para funcionar como una capa intermedia entre una trayectoria del extremo y el controlador de nivel de par de un robot redundante.

1. Objetivo de Compatibilidad con el Controlador: La QP minimiza una función de costo que equilibra la preservación de la tarea con la compatibilidad del controlador. La matriz de ponderación ($W_c$) incluye:

   • Línea Base Isotrópica: Asegura un buen condicionamiento.
   • Consistencia de la Orden Anterior ($W_\Delta$): Penaliza los cambios abruptos en la velocidad requerida respecto al paso anterior, promoviendo la suavidad.
   • Ponderación de Capacidad de Par del Actuador ($W_\tau$): Penaliza el uso de articulaciones con menor capacidad de par en relación con la articulación más fuerte del sistema. Esta ponderación se deriva de los límites conocidos de los actuadores, no del par medido.

2. Admisibilidad de Límites de Articulación: En lugar de utilizar restricciones estrictas que podrían volver la QP infactible, el método emplea desigualdades tipo Función de Barrera de Control (CBF) para definir un conjunto de velocidades requeridas admisibles ($D_r(q)$). Estos límites aseguran que la velocidad comandada no dirija la articulación demasiado rápido hacia sus límites mecánicos.

3. Restricción de Tarea Suave: Para manejar casos en los que el comando de la tarea es incompatible con el conjunto de velocidades admisibles, la ecuación de la tarea ($J\dot{q}_r = V_r$) se trata como una restricción suave utilizando una variable de holgura ($s$). El residuo de la tarea se penaliza en la función objetivo en lugar de ser el objetivo principal de minimización, lo que permite al optimizador priorizar la compatibilidad del controlador cuando sea necesario.

Contribuciones Clave

• Formulación: Una novedosa formulación de CI basada en QP que incorpora explícitamente la capacidad de par del actuador y la consistencia de la orden anterior en la resolución de la redundancia para robots controlados por par.
• Seguridad a Nivel de Referencia: La introducción de límites de tipo CBF sobre la velocidad requerida (la salida de la CI) en lugar de la entrada de la planta, proporcionando admisibilidad de límites de articulación a nivel de referencia sin modificar el controlador de nivel de par descendente.
• Compromiso de Admisibilidad de la Tarea: Un mecanismo para equilibrar la preservación de la tarea y la compatibilidad del controlador mediante el uso de una variable de holgura para la ecuación de la tarea, evitando que el residuo de la tarea prevalezca sobre la necesidad de referencias factibles y suaves.

Resultados Experimentales
El método fue evaluado en un exoesqueleto de miembro superior de 7 DoF utilizando un marco de trabajo de Control de Descomposición Virtual (VDC). Se comparó contra cuatro líneas base: Pseudoinversa (PINV), Mínimos Cuadrados Amortiguados (DLS), Evitación de Límites de Articulación en el Espacio Nulo (NS-JLA) y una QP de Preservación de Tarea (TP-QP) que utiliza las mismas restricciones de admisibilidad pero carece del objetivo de compatibilidad con el controlador.

• Desempeño Realizado: El método propuesto logró los errores de posición y orientación RMS más bajos, así como los residuos de velocidad de tarea realizados más bajos, superando a todas las líneas base. Notablemente, redujo el error de posición RMS en un 29.6% y el error de orientación RMS en un 20.2% en comparación con la línea base TP-QP.
• Comportamiento en el Límite: El método propuesto demostró un índice de "presión de límite" (comandos que dirigen el movimiento hacia los límites) significativamente menor, reduciéndolo hasta en un 96% en comparación con otros métodos.
• Eficiencia de Par: Resultó en la norma de par RMS más baja, lo que sugiere un uso más eficiente de los recursos de los actuadores.
• Admisibilidad: El método mantuvo cero violaciones de los límites de velocidad requerida admisibles, mientras que las líneas base cinemáticas (PINV, DLS, NS-JLA) excedieron estos límites frecuentemente.

Significancia y Reivindicaciones
El artículo sostiene que, para robots redundantes controlados por par, la CI no debe simplemente minimizar el error cinemático, sino que debe generar referencias a nivel de articulación que sean compatibles con el controlador descendente y las capacidades de los actuadores. Los resultados indican que la formulación propuesta logra un equilibrio superior entre la preservación de la tarea y la admisibilidad. Al generar referencias que respetan las capacidades de los actuadores y evitan el movimiento agresivo hacia los límites, el método mejora el comportamiento de la tarea realizada sin requerir un rediseño del controlador de nivel de par existente. Los autores enmarcan modestamente estos hallazgos como "conciencia de límites de articulación a nivel de referencia" y "resolución de redundancia compatible con el controlador", en lugar de una prueba formal de seguridad a nivel de planta. Como trabajo futuro, se identifica la investigación de formulaciones de restricciones acopladas de CI-control de par y el análisis de restricciones de lazo cerrado formal.