Coordinated Trajectory Control Algorithm for Quadcopter Motion along a Smooth Spatial Trajectory

Resumen Técnico: Algoritmo de Control de Trayectoria Coordinada para el Movimiento de un Cuadricóptero a lo Largo de una Trayectoria Espacial Suave

Planteamiento del Problema
El artículo aborda el desafío de controlar un cuadricóptero para que se mueva a lo largo de una trayectoria espacial tridimensional suave. Los autores distinguen entre dos paradigmas de control principales: el control de seguimiento, donde el robot intenta alcanzar una posición específica en un momento específico (lo que a menudo conduce a soluciones de camino más corto que pueden fallar en entornos ricos en obstáculos), y el control coordinado. En el control coordinado, la trayectoria y el perfil de velocidad a lo largo de dicha curva están preespecificados. El objetivo de control es minimizar la desviación respecto a la trayectoria, en lugar de la distancia a un punto específico en el tiempo, lo que permite al vehículo navegar alrededor de obstáculos ajustando su velocidad a lo largo de la curva.

El problema específico abordado aquí involucra un modelo dinámico no lineal de un cuadricóptero donde el grado relativo de los canales de control no es idéntico, lo que complica la descomposición del modelo. Además, la solución propuesta debe basarse únicamente en mediciones de salida (coordenadas lineales $x, y, z$ y ángulo de guiñada $\psi$) en lugar de mediciones completas del vector de estado, lo cual es una restricción significativa en comparación con los enfoques existentes de retroalimentación de estado.

Metodología
Los autores desarrollan una síntesis de control basada en un enfoque geométrico y retroalimentación de salida robusta:

1. Modelado Dinámico y Definición de Desviación:
   Se establece un modelo no lineal completo del cuadricóptero, que tiene en cuenta las coordenadas lineales y la orientación (guiñada, cabeceo y alabeo). La desviación respecto a la trayectoria deseada $S$ se define utilizando una transformación de coordenadas. Esto implica:

   • Una coordenada de trayectoria $s$ que representa el punto más cercano en la curva.
   • Dos coordenadas de error lineales ($e_1, e_2$) que representan la distancia a dos planos que se intersecan en el vector de velocidad deseado.
   • Errores angulares ($\delta\phi, \delta\theta, \delta\psi$), donde se asume que el cabeceo y el alabeo deseados son cero, y el guiñada deseada se deriva de la proyección de la trayectoria.

2. Transformación a Forma Normal:
   Para facilitar el diseño de control, el sistema se transforma en una "forma normal" utilizando una secuencia de diferenciaciones y cambios de coordenadas. Los autores introducen variables auxiliares e integradores para manejar la saturación de la entrada de control de empuje ($u_1$). Esta transformación da como resultado un sistema donde las variables reguladas ($\xi_1$) y sus derivadas ($\xi_2, \xi_3, \xi_4$) forman un vector de estado extendido. Se demuestra que el sistema es invertible, lo que permite la reconstrucción de las entradas de control originales a partir de las variables de la forma normal.

3. Síntesis de Control Robusto por Retroalimentación de Salida:

   • Retroalimentación de Estado Ideal: Inicialmente, se sintetiza una ley de control asumiendo la disponibilidad completa del estado. Esta ley utiliza una estructura de retroalimentación lineal con ganancias ($\gamma_1$ a $\gamma_4$) elegidas para formar un polinomio de Hurwitz, asegurando la estabilidad asintótica local de la dinámica del error.
   • Implementación de Retroalimentación de Salida: Reconociendo que no está disponible la medición completa del estado, los autores emplean un método de observador extendido. Se diseña un observador de alta ganancia para estimar los estados no medidos ($\hat{\xi}_2, \hat{\xi}_3, \hat{\xi}_4$) y el término de perturbación desconocido ($\hat{\sigma}$).
   • Ley de Control: La ley de control final utiliza estos estados estimados e incluye una función de saturación suave para asegurar que las entradas de control permanezcan dentro de los límites físicos. Las fuerzas de empuje para los cuatro propulsores se calculan invirtiendo la matriz de transformación derivada de la forma normal.

Contribuciones Clave

• Modelo 3D Completo: A diferencia de trabajos anteriores que utilizaron modelos incompletos que ignoraban la dinámica de guiñada o estaban restringidos al movimiento planar, este artículo presenta un modelo dinámico completo para el movimiento del cuadricóptero en el espacio 3D.
• Control Coordinado por Retroalimentación de Salida: El artículo sintetiza una ley de control coordinado que depende únicamente de las mediciones de coordenadas lineales y ángulo de guiñada, abordando la dificultad de los grados relativos no idénticos en los canales de control.
• Sintonización Simplificada: Al utilizar integradores adicionales y un algoritmo de control dinámico, los autores proponen una metodología con sintonización de reguladores simplificada en comparación con algoritmos de control de seguimiento anteriores que requerían una selección compleja de parámetros para satisfacer las condiciones de demostración.
• Robustez: La inclusión de un observador extendido permite que el sistema maneje términos y perturbaciones desconocidos, proporcionando una solución robusta para el seguimiento de trayectorias.

Resultados y Afirmaciones
El artículo proporciona una demostración teórica de la estabilidad local para el sistema de lazo cerrado. Los autores demuestran que si los parámetros del controlador se eligen como coeficientes de un polinomio de Hurwitz, las variables de desviación ($\tilde{\xi}$) tienden asintóticamente a cero. Esto garantiza que el cuadricóptero:

1. Siga la curva espacial prescrita.
2. Mantenga el perfil de velocidad prescrito a lo largo de la curva.
3. Mantenga los errores de orientación dentro de límites acotados.

La derivación matemática confirma que la ley de control logra los objetivos de minimizar la desviación de la trayectoria y mantener la velocidad y orientación deseadas, siempre que la curvatura de la trayectoria esté acotada y las condiciones iniciales se encuentren dentro de la región de atracción.

Significado
El artículo afirma cerrar una brecha en la literatura al extender el control de trayectoria coordinada desde robots móviles planares hasta el movimiento de cuadricópteros en 3D utilizando únicamente retroalimentación de salida. Se contrasta con trabajos anteriores que o bien utilizaban modelos incompletos o requerían mediciones completas del estado. El significado radica en proporcionar un algoritmo robusto y teóricamente fundamentado para el seguimiento de trayectorias espaciales que es prácticamente implementable dadas las restricciones estándar de sensores (posición y guiñada), sin necesidad de una estimación compleja del estado de las tasas angulares o de vectores completos de orientación. Los autores señalan que, aunque se ha establecido el marco teórico, se planean estudios experimentales a gran escala para trabajos futuros a fin de validar la ley de control sintetizada.