Time-Optimal Switching Surfaces for Triple Integrator under Full Box Constraints

Resumen Técnico: Superficies de Conmutación Óptimas en Tiempo para un Triple Integrador bajo Restricciones de Caja Completas

Enunciado del Problema
Este artículo aborda el problema de control óptimo en tiempo para un sistema de triple integrador sujeto a restricciones de caja completas. La dinámica del sistema involucra entradas de control limitadas en la aceleración ($u$) y restricciones de estado sobre la posición ($x_1$), la velocidad ($x_2$) y la aceleración ($x_3$). El objetivo es transferir el sistema desde un estado inicial arbitrario $\mathbf{x}_0$ a un estado terminal fijo $\mathbf{x}_f$ en el tiempo mínimo $t_f$.

Si bien el control óptimo en tiempo para dobles integradores está bien comprendido, el caso del triple integrador presenta desafíos significativos, particularmente al tratar con:

1. Restricciones asimétricas: Donde los límites superiores e inferiores para la aceleración y los estados no son iguales en magnitud.
2. Condiciones de frontera no estacionarias: Estados iniciales y terminales arbitrarios.
3. Restricciones de posición activas: Escenarios donde la trayectoria debe tocar o deslizarse a lo largo de los límites de las restricciones de posición ($x_3 = \bar{x}_3$ o $x_3 = \underline{x}_3$).

Las soluciones existentes, como el algoritmo comercial Ruckig (versión comunitaria), a menudo fallan bajo restricciones asimétricas o restricciones de posición activas. Los enfoques analíticos previos han ignorado las restricciones de estado, asumido restricciones simétricas o no han proporcionado una caracterización completa de las superficies de conmutación y las condiciones activas para las restricciones de posición.

Metodología
Los autores utilizan el Principio del Máximo de Pontryagin (PMP) para caracterizar la ley de control óptima, la cual sigue una estructura Bang-Bang-Singular (BBS). El núcleo de la metodología implica un análisis geométrico del espacio de estados para derivar superficies de conmutación óptimas en tiempo.

1. Ley de Conmutación Aumentada (ASL): La trayectoria óptima se representa como una secuencia de arcos (arcos bang-bang no restringidos y arcos restringidos donde los estados están fijos) y "marcadores tangentes". Un marcador tangente ocurre cuando la restricción de posición se activa tangencialmente (es decir, $x_3 = \bar{x}_3$, $x_2 = 0$ y $x_1 \geq 0$).
2. Construcción de Superficies de Conmutación:
   • Sin Restricciones de Posición: Los autores construyen variedades de conmutación mediante integración hacia atrás desde el estado terminal $\mathbf{x}_f$. Definen superficies que corresponden a ASLs específicas (por ejemplo, $\bar{0}\bar{0}\bar{0}$, $\bar{0}\bar{1}\bar{0}\bar{0}$) que dividen el espacio de estados 3D.
   • Con Restricciones de Posición: El artículo deriva las condiciones específicas bajo las cuales las restricciones de posición se vuelven activas. Introduce nuevas superficies de conmutación (por ejemplo, $\bar{0}(\bar{3}, 2)\bar{0}\bar{0}\bar{0}$) que tienen en cuenta trayectorias tangentes al límite de posición. El Teorema 2 proporciona una clasificación completa de todas las formas posibles de ASL para el triple integrador con restricciones de caja completas, estableciendo que las trayectorias óptimas consisten en secuencias de arcos no restringidos y marcadores tangentes.
3. Implementación Algorítmica:
   • Algoritmo 1: Determina la dirección relativa entre $\mathbf{x}_0$ y $\mathbf{x}_f$ analizando proyecciones de segundo orden, manejando casos donde las superficies de conmutación son multivaluadas.
   • Algoritmo 2: Resuelve el problema sin restricciones de posición conectando estados mediante controles óptimos de segundo orden y resolviendo ecuaciones polinómicas para las duraciones de los arcos.
   • Algoritmo 3: Extiende la solución a restricciones de caja completas. Si la solución sin restricciones viola las restricciones de posición, el algoritmo conecta recursivamente el estado con un marcador tangente (derivado del Teorema 2) y resuelve los subproblemas.
   • El sistema de ecuaciones para las duraciones de los arcos se resuelve utilizando bases de Gröbner, reduciendo el problema a una única ecuación polinómica de grado $\leq 6$.

Contribuciones Clave

• Caracterización Completa de Superficies de Conmutación: Por primera vez, el artículo proporciona una caracterización analítica completa de las superficies de conmutación óptimas en tiempo para el triple integrador bajo restricciones de caja completas, incluyendo la estructura geométrica de las soluciones con restricciones de posición activas.
• Derivación de Condiciones Activas: El artículo deriva explícitamente las condiciones bajo las cuales las restricciones de posición se vuelven activas (la condición de "marcador tangente"), una brecha previamente ausente en la literatura.
• Teorema 2 (Clasificación ASL): Establece el conjunto completo de Leyes de Conmutación Aumentadas permitidas para este problema, demostrando que las trayectorias óptimas siguen secuencias específicas que involucran marcadores tangentes.
• Algoritmo Eficiente: Se propone un algoritmo que planifica trayectorias óptimas en tiempo para estados de frontera arbitrarios y restricciones asimétricas.

Resultados
El método propuesto se evaluó frente a tres líneas base: Ruckig (versión comunitaria), CasADi (basado en IPOPT) y SCP (Programación Convexa Secuencial).

• Tasa de Éxito: El método propuesto logró una tasa de éxito del 100% en la búsqueda de soluciones factibles tanto para restricciones simétricas (Caso 1) como asimétricas con restricciones de posición activas (Caso 2). Por el contrario, Ruckig falló en el Caso 2 debido a la asimetría, y SCP/CasADi mostraron tasas de éxito significativamente más bajas (34.1% y 97.7% respectivamente en el Caso 2).
• Eficiencia Computacional: El tiempo computacional promedio por trayectoria fue de aproximadamente 10 $\mu$s (específicamente $2.38 \times 10^{-6}$ s para el Caso 1 y $1.25 \times 10^{-5}$ s para el Caso 2). Esto representa una reducción de 5 órdenes de magnitud en comparación con las líneas base basadas en optimización (CasADi: ~0.28s; SCP: ~7.28s).
• Optimalidad: El método encontró consistentemente soluciones óptimas globales. En casos de prueba donde los métodos basados en optimización convergieron a óptimos locales (ASLs subóptimos), el método propuesto redujo el tiempo terminal hasta en un 90.9% (Caso 1) y 73.4% (Caso 2).

Significado
Los autores afirman que este trabajo proporciona la primera caracterización completa de superficies de conmutación y un algoritmo eficiente para el problema de control óptimo en tiempo de tercer orden bajo condiciones terminales no estacionarias y restricciones de posición activas. Al alejarse de la optimización iterativa hacia una solución geométrica y analítica, el artículo demuestra que el control óptimo en tiempo de alta precisión puede lograrse con tiempos de computación a nivel de microsegundos, haciéndolo altamente adecuado para aplicaciones industriales en tiempo real como el movimiento robótico y el mecanizado por control numérico, donde las restricciones suelen ser asimétricas y activas.