Compliant Explicit Reference Governor for Contact Friendly Robotic Manipulators

Resumen Técnico: Gobernador de Referencia Explícito Cumplidor para Manipuladores Robóticos Amigables con el Contacto

Enunciado del Problema
La planificación de movimientos robótica tradicional prioriza la evitación de colisiones para garantizar la seguridad, tratando a menudo el contacto ambiental como un obstáculo. Sin embargo, la robótica moderna requiere cada vez más capacidades "ricas en contacto", donde la interacción física es un recurso. El desafío central radica en gestionar la transición entre el movimiento libre y el contacto, satisfaciendo simultáneamente dos tipos distintos de restricciones:

1. Restricciones Duras: Límites no negociables como rangos articulares, límites de par y superficies prohibidas.
2. Restricciones Suaves: Condiciones donde el contacto es permisible pero debe manejarse de forma segura. Estas crean condiciones "O" altamente no convexas: el robot debe evitar el contacto por completo o operar bajo restricciones específicas de contacto seguro.

Las estrategias existentes basadas en optimización (por ejemplo, Control Predictivo de Modelo) a menudo requieren rediseños completos de las leyes de control y aproximaciones complejas de dinámica de contacto dependientes del tiempo, lo cual resulta poco atractivo para los practicantes con controladores heredados. Por el contrario, enfoques jerárquicos como las Funciones de Barrera de Control o la compliancia basada en energía a menudo carecen de garantías estrictas de restricción o de estabilidad asintótica. El Gobernador de Referencia Explícito (ERG) ofrece un filtro de seguridad jerárquico que modifica las referencias sin alterar el controlador subyacente, pero las implementaciones anteriores trataban el contacto como indeseable, deteniendo el movimiento al producirse contacto. Este artículo aborda la necesidad de un marco que permita una operación continua y segura durante el contacto sin modificar el controlador de bajo nivel.

Metodología: El Gobernador de Referencia Explícito Cumplidor (CERG)
Los autores proponen el Gobernador de Referencia Explícito Cumplidor (CERG), un sistema modular de gestión de referencias colocado entre un planificador de alto nivel y un controlador de bajo nivel. El CERG hace cumplir las restricciones operativas y permite transiciones suaves entre operaciones de movimiento libre y de contacto manipulando la señal de referencia $v(t)$ enviada a un controlador pre-estabilizado.

La metodología se basa en tres componentes clave:

1. Capa de Pre-estabilización: Un controlador PD estándar con compensación de gravedad dirige al robot hacia una configuración de referencia $v$. La energía total del sistema (cinética + potencial virtual) se define mediante una función de Lyapunov $V(x, v)$, que es monótonamente decreciente cuando $v$ es constante.
2. Margen de Seguridad Dinámico Cumplidor (DSM): La innovación central es un DSM, $\Delta(x, v)$, diseñado para manejar la naturaleza disyuntiva (O) de las restricciones de contacto. La condición de seguridad se formula como:
   $$s(q(t)) < 0 \quad \lor \quad V(x(t), v(t)) \le E_{\max}$$
   donde $s(q) < 0$ representa el movimiento libre y $V \le E_{\max}$ representa un contacto seguro con energía acotada. El CERG construye un DSM compuesto:
   $$\Delta(x, v) = \min(\Delta_h, \max(\Delta_s, \Delta_E))$$
   • $\Delta_h$: Hace cumplir las restricciones duras (límites articulares, etc.).
   • $\Delta_s$: Un margen basado en la trayectoria para la superficie de restricción suave $s(q)$.
   • $\Delta_E$: Un margen basado en la energía definido como $\kappa_E(E_{\max} - V(x, v))$.
     Esta estructura asegura que si el robot está en movimiento libre, la restricción de energía se relaja; si ocurre contacto, la energía total del sistema se acota estrictamente por $E_{\max}$.
3. Campo de Navegación Suave (NF): A diferencia de las restricciones duras que repelen la referencia, el CERG emplea un campo de repulsión "suave" $\rho_s(v)$ que permite que la referencia $v$ penetre la frontera de restricción hasta un límite $\delta_s$. Esta penetración es necesaria para generar la fuerza requerida para el contacto cumplidor. El campo de navegación total combina la atracción hacia el objetivo, la repulsión de las restricciones duras y esta repulsión suave.

Contribuciones Clave
El artículo afirma tres contribuciones principales:

• Filtrado Modular de Referencias: Un marco que transiciona sin problemas entre movimiento sin contacto y rico en contacto, respetando las restricciones de ángulo, velocidad y par articulares, sin requerir rediseño del controlador.
• Manejo de Restricciones Disyuntivas: Un mecanismo de seguridad diseñado específicamente para restricciones de tipo "O", garantizando la satisfacción demostrable de evitar el contacto o mantener una energía acotada durante el contacto.
• Directriz de Seguridad Basada en Energía: Una métrica de seguridad basada en la energía mecánica total (potencial + cinética) del sistema de lazo cerrado. Esta métrica es invariante al marco de referencia, se vincula directamente con garantías de estabilidad y es fácilmente interpretable.

Resultados y Validación
El CERG fue validado numérica y experimentalmente en sistemas de creciente complejidad:

• Brazo Plano de Dos Eslabones (Simulación): El CERG fue probado con controladores tanto en espacio articular como en efector final. Los resultados mostraron que el CERG redujo exitosamente las fuerzas de interacción en comparación con la operación sin él y respetó los límites de energía. El estudio notó que, aunque la formulación en espacio de efector final minimiza el error cartesiano, la formulación en espacio articular es preferible para arquitecturas jerárquicas.
• Simulación Franka Emika Panda (Drake): Utilizando un modelo de contacto cumplidor con fricción y disipación, el CERG fue probado en una tarea que requería que el brazo se deslizara a lo largo de una pared. La simulación confirmó que el CERG se adhirió al límite $E_{\max}$ durante el contacto, mientras que un ERG estándar (que se detiene al producirse contacto) y un sistema sin modificar fallaron en gestionar la transición de energía de manera efectiva.
• Experimentos en el Mundo Real (Franka Emika Panda): Se realizaron dos tareas:
  1. Limpieza de Pizarra: Una tarea no altamente sensible a la energía. El CERG, el ERG y el control de impedancia completaron la tarea, pero solo el CERG hizo cumplir las restricciones duras (evitando violaciones de velocidad articular) y los límites de energía durante el contacto.
  2. Empuje de Torre Jenga: Una tarea altamente sensible a la energía. El controlador de impedancia falló debido a violaciones de límites articulares o al volcamiento de la torre. El ERG estándar falló en prevenir el volcamiento debido a una energía de contacto excesiva. Solo el CERG empujó la torre con éxito sin volcarla, haciendo cumplir estrictamente $E_{\max}$ durante el contacto mientras permitía mayor energía en movimiento libre.

Significado y Afirmaciones
El artículo afirma que el CERG proporciona una solución práctica para la manipulación rica en contacto actuando como un filtro de seguridad "plug-and-play". Su importancia radica en permitir que los robots traten el contacto como un recurso en lugar de un peligro, sin la carga computacional de rediseños completos de MPC o los riesgos de inestabilidad de controladores sin modificar. El marco garantiza la seguridad mediante restricciones demostrables sobre la energía total del sistema, permitiendo transiciones de fase sin problemas entre movimiento libre y contacto. Los autores concluyen que el enfoque es factible y efectivo, con trabajos futuros planeados para interconectar el CERG con planificadores orientados a tareas.