A Geometric Task-Space Port-Hamiltonian Formulation for Redundant Manipulators

Resumen Técnico: Una Formulación Port-Hamiltoniana de Espacio de Tareas Geométrico para Manipuladores Redundantes

Planteamiento del Problema
Los manipuladores redundantes, que poseen más grados de libertad (DOF) de los requeridos para una tarea cinemática diferencial específica, presentan un desafío en cuanto a modelado y control. Aunque las formulaciones lagrangianas para la redundancia están bien establecidas en la literatura (por ejemplo, Dietrich et al., 2015; Ott et al., 2015), existe la necesidad de un marco geométrico riguroso dentro de la formalización Port-Hamiltoniana (pH) que gestione explícitamente la descomposición de la energía y la potencia entre el espacio de la tarea y el espacio nulo. Los enfoques pH existentes para el modelado de impedancia en el espacio de tareas (por ejemplo, Scherpen et al., 2025) a menudo abordan sistemas no redundantes o no explotan plenamente las propiedades estructurales de la redundancia. El problema central abordado es la falta de un modelo pH que descomponga naturalmente los puertos de momento y potencia del sistema en componentes de espacio de tarea y espacio nulo, facilitando el análisis basado en energía y el diseño de control para sistemas redundantes.

Metodología
Los autores proponen una novedosa formulación pH geométrica derivada de una transformación de coordenadas de la dinámica Hamiltoniana estándar. La metodología procede a través de los siguientes pasos:

1. Descomposición Geométrica:

   • Espacio de Velocidades: Utilizando la métrica de inercia $M(q)$, el espacio tangente $T_qQ$ se descompone en el núcleo del Jacobiano de la tarea $J(q)$ (espacio nulo) y su complemento $M$-ortogonal. Esto permite que la velocidad articular $\dot{q}$ se divida de forma única en un componente de velocidad de la tarea $v$ y un componente de espacio nulo $\nu$.
   • Espacio de Fuerzas: Se aplica una descomposición dual al espacio de fuerzas generalizadas $T^*_qQ$. El torque $\tau$ se descompone en un componente $\tau_F$ en la imagen de $J^\top$ (fuerzas del espacio de la tarea) y un componente $\tau_0$ en el anulador del subespacio de velocidad del espacio de la tarea (fuerzas del espacio nulo).
   • Balance de Potencia: Esta descomposición revela que la potencia mecánica $\tau^\top \dot{q}$ se divide en dos términos independientes: $\tau_F^\top v$ (potencia de la tarea) y $\tau_0^\top \nu$ (potencia del espacio nulo).

2. Transformación de Coordenadas:

   • Velocidad Extendida: Para integrar esta descomposición en la estructura pH, los autores definen una velocidad de tarea extendida $\eta_e = \bar{J}(q)\dot{q}$, donde $\bar{J}$ combina el Jacobiano de la tarea $J$ y una matriz de base del espacio nulo $N$.
   • Cambio de Coordenadas: Se aplica un cambio de coordenadas $\Phi$ a la el estado Hamiltoniano estándar $(q, p)$, transformando el momento $p$ en un momento extendido $\pi_e = \bar{J}^{-\top}(q)p$.
   • Estado Resultante: Esta transformación produce un nuevo vector de estado $z = (q, \pi, \pi_\nu)$, donde $\pi$ representa el momento del espacio de la tarea y $\pi_\nu$ el momento del espacio nulo. Se demuestra que la energía cinética se descompone en una suma de formas cuadráticas de la tarea y del espacio nulo involucrando la inversa del tensor de movilidad extendido $\bar{\Lambda}$.

3. Formulación del Sistema:

   • El sistema resultante es un sistema port-Hamiltoniano (Ecuación 27) con una matriz de interconexión antisimétrica $J_z$. El sistema presenta dos puertos de potencia distintos: un puerto de la tarea $(\sigma, \eta)$ y un puerto del espacio nulo $(\tau_0, \nu)$.
   • La matriz de interconexión incluye términos fuera de la diagonal ($G_{12}$) que modelan explícitamente el acoplamiento de energía interna entre la dinámica de la tarea y la del espacio nulo.

4. Diseño de Control (IDA-PBC):

   • Los autores aplican el marco de Control Basado en la Pasividad de Asignación de Interconexión y Amortiguamiento (IDA-PBC) al nuevo modelo.
   • El objetivo de control es estabilizar un equilibrio de la tarea deseada $x^*$ y dar forma a la impedancia del espacio de la tarea.
   • Las condiciones de coincidencia (matching conditions) se resuelven preservando la estructura de la energía cinética e introduciendo una energía potencial modelada $V_c(q)$.
   • La ley de control resultante consta de tres componentes: Modelado de Energía (para definir el equilibrio), Enrutamiento de Energía (para modificar las interconexiones sin disipar energía) e Inyección de Amortiguamiento (para asegurar la estabilidad asintótica).

Contribuciones Clave

• Nuevo Modelo pH Geométrico: El artículo presenta la primera formulación pH para manipuladores redundantes que descompone rigurosamente el momento y la potencia en componentes de espacio de tarea y espacio nulo mediante una transformación de coordenadas.
• Descomposición Dual: Introduce una descomposición dual del espacio de fuerzas generalizadas que es físicamente significativa y matemáticamente consistente con la descomposición de velocidades, utilizando proyectores dinámicamente consistentes.
• Puertos de Potencia Explícitos: El modelo identifica explícitamente dos pares de puertos conjugados de potencia: uno para el espacio de la tarea (que modela interacciones externas) y otro para el espacio nulo (que modela la dinámica de la redundancia interna).
• Modelado de Impedancia vía IDA-PBC: Los autores demuestran la utilidad del modelo mediante el diseño de un controlador IDA-PBC que estabiliza una configuración de la tarea y da forma activamente a la impedancia (rigidez y amortiguamiento) en el puerto de la tarea.

Resultados
La metodología propuesta fue validada mediante simulaciones en un robot Franka Emika Panda de 7 DOF realizando una tarea de posición cartesiana de 3 DOF.

• Estabilidad: Se demostró que el sistema en bucle cerrado es estable, con el Hamiltoniano total $H_{cl}$ manteniéndose no creciente en ausencia de perturbaciones externas.
• Comportamiento de la Impedancia: Las simulaciones demostraron la capacidad de dar forma a la impedancia del espacio de la tarea. Al variar el término de energía potencial $V_c(q)$, los autores lograron diferentes perfiles de rigidez (suave vs. rígido) en el equilibrio.
• Gestión de la Redundancia: Los resultados confirmaron que el controlador puede estabilizar la posición de la tarea $x^*$ mientras gestiona la dinámica del espacio nulo. Diferentes configuraciones articulares $q^*$ que conducen al mismo $x^*$ fueron estabilizadas con éxito con distintos comportamientos de energía del espacio nulo, ilustrando la capacidad del controlador para manejar la redundancia.
• Trayectorias de Energía: Los gráficos de simulación mostraron la evolución de la energía del espacio de la tarea ($\bar{K}_t$), la energía del espacio nulo ($\bar{K}_\nu$) y la energía total ($H_{cl}$), confirmando los intercambios de energía y las características de disipación esperadas.

Significancia y Reivindicaciones
Los autores afirman que este trabajo proporciona una base teórica rigurosa para analizar y controlar manipuladores redundantes dentro del marco port-Hamiltoniano. Al descomponer el sistema en puertos de tarea y de espacio nulo, el modelo facilita:

1. Análisis Basado en Energía: Simplifica el análisis de los flujos de energía y las propiedades de pasividad en comparación con las descripciones lagrangianas tradicionales.
2. Control Modular: Abre nuevas posibilidades para las estrategias de control en el espacio de tareas que consideran explícitamente la redundancia, permitiendo el modelado independiente de la impedancia de la tarea y el comportamiento del espacio nulo.
3. Perspectiva Estructural: La formulación revela la naturaleza geométrica del acoplamiento entre la dinámica de la tarea y la del espacio nulo, que a menudo queda oculto en otras formulaciones.

El artículo concluye que esta formulación es un paso significativo hacia el desarrollo de estrategias de control avanzadas y conscientes de la energía para sistemas robóticos redundantes, particularmente para aplicaciones que requieren un control de impedancia preciso y una interacción física segura.