Robust Global Position and Heading Tracking on SE(3) via Saturated Hybrid Feedback

Resumen Técnico: Control Híbrido Saturado para Seguimiento Global en SE(3)

1. Problema Abordado

El artículo aborda el desafío fundamental del seguimiento de trayectorias globales para vehículos subactuados (como drones o vehículos aéreos no tripulados) que operan bajo límites estrictos de actuación (saturación de empuje y torque).

Los principales obstáculos identificados son:

• Subactuación: El número de grados de libertad excede las entradas de control disponibles (un solo eje de empuje y torque completo).
• Saturación de Actuadores: Las limitaciones físicas de los motores (empuje máximo $T_{max}$ y torque máximo $\tau_{max}$) son no linealidades inevitables que, si se ignoran, degradan el rendimiento o causan inestabilidad.
• Topología de SE(3): El espacio de configuración del movimiento de cuerpos rígidos, el grupo Euclidiano Especial $SE(3)$, no es homeomorfo a un espacio Euclidiano. Esto impide la estabilización global mediante retroalimentación continua. Además, los controladores discontinuos puros carecen de robustez global ante pequeñas perturbaciones.
• Acoplamiento Geométrico: Las metodologías existentes a menudo priorizan las restricciones de empuje, ignorando la saturación de torque, o generan referencias de actitud que restringen el seguimiento de la guiñada (yaw) a condiciones de rodaje y cabeceo nulos.

El objetivo es diseñar una ley de control que garantice el seguimiento global asintótico y semi-global exponencial de la posición y la dirección de la cabeza (heading), respetando simultáneamente los límites de saturación de empuje y torque.

2. Metodología Propuesta

La solución propuesta es una arquitectura de control jerárquica híbrida que combina un controlador de posición saturado con un bucle interno de actitud basado en parámetros de Rodrigues modificados (MRP) y un mecanismo de elevación de trayectoria.

A. Controlador de Posición Saturado con Filtros (Bucle Externo):

• Estrategia: Se introduce un controlador de seguimiento de posición que utiliza dos filtros de primer orden en lugar de funciones de saturación anidadas complejas.
• Transformación de Coordenadas: Se emplea una transformación de coordenadas proyectada hacia adelante que desacopla estructuralmente la dinámica de los filtros de la dinámica del doble integrador. Esto permite diseñar el controlador asumiendo una actuación ideal de ancho de banda infinito, mientras que las limitaciones de los filtros se encapsulan algebraicamente.
• Beneficio: Esta formulación asegura que el controlador y sus dos primeras derivadas estén acotados, generando referencias de velocidad y aceleración angular factibles de manera analítica y ajustable mediante parámetros de diseño.

B. Controlador de Actitud Saturado Híbrido (Bucle Interno):

• Representación: Se utiliza la representación de Parámetros de Rodrigues Modificados (MRP) para describir el error de actitud.
• Mecanismo Híbrido: Se implementa un algoritmo de elevación de trayectoria dinámica híbrida (path-lifting). Este mecanismo permite que el controlador opere en un espacio de cobertura del manifold de actitud ($SO(3)$), evitando singularidades y garantizando la estabilidad global.
• Ley de Control: Se diseña una ley de control saturada basada en MRP que incluye términos de retroalimentación proporcional y derivativa, junto con un término de cancelación de feedforward.
• Estabilidad: Se utiliza un marco de equivalencia de estabilidad para demostrar que la estabilidad lograda en el espacio de MRP se traduce rigurosamente a la estabilidad global en el grupo de rotación $SO(3)$.

C. Análisis de Estabilidad del Sistema Interconectado:

• Se demuestra que el sistema interconectado (posición + actitud) logra estabilidad asintótica global y estabilidad exponencial semi-global en $SE(3)$.
• Se utilizan funciones de Lyapunov con decaimiento exponencial (en lugar de argumentos de ganancia pequeña) para establecer estas garantías bajo límites de actuación estrictos.
• El sistema es nominalmente robusto frente a perturbaciones externas, incertidumbres paramétricas y ruido de medición.

3. Contribuciones Clave

1. Primera Solución Robusta Semi-Globalmente Exponencial: Se presenta, hasta donde se sabe, la primera solución de seguimiento robusto y semi-globalmente exponencialmente estable para vehículos subactuados propulsados por empuje que enfrentan saturación simultánea de empuje y torque.
2. Nueva Arquitectura de Filtros: Sustitución de las funciones de saturación anidadas (usadas en trabajos previos como [9]) por una estructura de filtros de primer orden. Esto simplifica las expresiones de las derivadas del controlador y proporciona límites analíticamente tratables y fácilmente ajustables.
3. Seguimiento de Guiñada Sin Restricciones: A diferencia de enfoques anteriores que restringían el seguimiento exacto de la guiñada a condiciones de rodaje/cabeceo nulos, esta metodología permite un seguimiento de dirección de cabeza (heading) ilimitado.
4. Garantías de Factibilidad a Priori: La arquitectura permite verificar antes de la implementación si una trayectoria es factible bajo los límites de actuación dados, ajustando los parámetros de diseño de los filtros.

4. Resultados de Simulación

Las simulaciones numéricas validan la propuesta bajo condiciones extremas:

• Escenario: Un vehículo subactuado con masa de 0.46 kg y límites de empuje de 7 N y torque de 0.5 Nm.
• Condiciones Iniciales: Se inicia con un error de actitud significativo (orientación hacia abajo, $\phi = -179^\circ$) y una posición alejada de la trayectoria deseada.
• Desempeño:
  • El sistema logra recuperar la orientación y seguir la trayectoria deseada a pesar del error inicial masivo.
  • Los errores de posición y norma de error MRP convergen a valores muy bajos (< 0.001 m y < 0.0001 respectivamente).
  • Las señales de control (empuje y momentos) permanecen estrictamente dentro de los límites teóricos derivados ($T \in [3.51, 6.19]$ N y $|\tau| \leq 0.48$ Nm).
  • Se observa un retraso transitorio debido a los filtros, pero el sistema mantiene la estabilidad y el seguimiento preciso.

5. Significado e Impacto

Este trabajo cierra una brecha crítica en la literatura de control de vehículos subactuados al integrar rigurosamente las limitaciones de saturación de ambos tipos de actuadores (empuje y torque) en un marco de estabilidad global.

La metodología propuesta es significativa porque:

• Ofrece una solución práctica y robusta para aplicaciones reales donde los actuadores tienen límites físicos estrictos.
• Proporciona garantías matemáticas rigurosas (estabilidad global y exponencial) en un espacio de configuración no trivial ($SE(3)$), superando las limitaciones de los enfoques continuos o discontinuos puros.
• Facilita el diseño y ajuste del controlador mediante parámetros intuitivos (ganancias de filtros), permitiendo a los ingenieros ajustar los límites de las referencias de actitud de manera sistemática.

En resumen, el artículo establece un nuevo estándar para el control de seguimiento de trayectorias en vehículos subactuados, combinando la teoría de sistemas híbridos con técnicas de saturación avanzada para lograr un rendimiento robusto y globalmente estable.