Estudio de caso: Aplicar Routh-hurwitz para estabilizar un sistema de control de cuádromo

En los sistemas de control modernos, la estabilidad es la piedra angular de una operación segura y predecible. En ningún lugar es más evidente que en los drones de cuadrilo, donde la inestabilidad puede conducir a una falla catastrófica en segundos. Este estudio muestra la aplicación práctica de los criterios de Routh-Hurwitz para analizar y estabilizar el sistema de control de un dron de cuadrilo.

Quadrotor Dynamics y Control Architecture

Un polidromo es un sistema no lineal infraaccionado y muy acoplado. Su movimiento se controla por variar las velocidades de cuatro rotores, que generan empuje y par. Para el análisis de estabilidad, el sistema se linealiza generalmente alrededor de una condición de buceador angular, dando un conjunto de ecuaciones diferenciales de segundo orden descodificadas para la rotación, el lanzamiento, el yopción, y la altitud.

Modelo linealizado para eje de rodillo

Considere la dinámica del rollo. La ecuación linealizada del movimiento es:

] es el ángulo del rodamiento, es el momento de la inercia, es el derivado aerodinámico de amortiguación, y es el derivado de control que representa el par producido por el empuje diferencial. Un controlador PID proporciona la señal de control:

La sustitución y formación de la función de transferencia de circuito cerrado produce un polinomio característico del orden tres (o superior si se incluyen dinámicas de sensores). Para un sistema de tercera orden:

El criterio de Routh-Hurwitz nos permite analizar el signo de las partes reales de las raíces sin un hallazgo de raíz explícito.

El Criterio Routh-Hurwitz: Un test de estabilidad sistémico

Desarrollado independientemente por Edward John Routh y Adolf Hurwitz, el criterio Routh-Hurwitz proporciona una condición necesaria y suficiente para la estabilidad de los sistemas lineales de tiempo invariable. Utiliza los coeficientes del polinomio característico para construir un array (el array Routh). El número de cambios de signo en la primera columna de este array equivale al número de raíces con partes reales positivas. Para un sistema para ser primera columna, todos los registros tienen

Construyendo el Array de Routh

Dado un polinomio , el conjunto Routh se construye fila por fila:

Si cualquier elemento de la primera columna se convierte en cero, se requiere un manejo especial (sustituir con un pequeño epsilón o utilizar el método auxiliar de polinomial). Si una fila entera se convierte en cero, el polinomio tiene raíces simétricas, y el array sigue utilizando un polinomio auxiliar.

Condiciones de Estabilidad para Sistemas Terceros

Para un polinomio cúbico , las condiciones Routh-Hurwitz simplifican:

Esta regla directa se utiliza a menudo como un cheque rápido antes de construir el array completo.

Aplicación al Sistema de Control de Rollo de Quadrotor

Para nuestro estudio de caso de quadrotor, el polinomio característico para el eje de rodillos, incluyendo las ganancias del controlador PID y dinámicas del rotor (modificado como un lag de primer orden con τ constante del tiempo), se deriva como:

Donde los valores numéricos del sistema físico son: τ = 0.05 s (temporal de rotación), I xx = 0.01 kg·m2, L 2 = 0.5 N·m por control unitario. Las ganancias iniciales del PID fueron elegidas en base a la afinación heurística: K p = 10, K i = 2, K d = 5.

→

Construyendo el Array Routh

Construimos el array para este polinomio de cuatro órdenes:

Los primeros valores de columna son: 0.05, 1.5, 13.367, 50.84, 10 – todos positivos, sin cambios de signo. Por lo tanto, el sistema con estas ganancias es estable. Sin embargo, si aumentamos el beneficio integral a K i = 20, los coeficientes polinomios cambian y la matriz de Routh revela un cambio de signo, lo que indica inestabilidad. Esto demuestra el poder del criterio para la exploración espacial del parámetro.

Tuning de parámetro Usando Routh-Hurwitz Constraints

En lugar de simulación de ensayo y terror, el criterio de Routh-Hurwitz proporciona desigualdades algebraicas que deben ser satisfechas para la estabilidad. Para el polinomio de cuarto orden que obtuvimos, las condiciones necesarias son:

Al expresar las primeras entradas de columna simbólicamente en términos de K p, K i y K d, hemos derivado tres ecuaciones de restricción. Resolver estas desigualdades define una región estable en el espacio de ganancia. Para nuestro quadrotor, la región estable fue encontrada como:

Estas limitaciones guiaron la selección de los logros finales: K p = 8, K i = 1, K d = 4, que se encuentran bien dentro de la región estable y también proporcionan un buen margen de fase cuando se evalúa mediante la respuesta de frecuencia.

Resultados de simulación y validación

Una simulación no lineal del quadrotor en el entorno Gazebo] se utilizó para validar los márgenes de estabilidad. Con los beneficios optimizados para Routh-Hurwitz, la respuesta del rodillo a una entrada de 10 grados mostró un tiempo de ajuste de 0.8 segundos, superó menos del 5% y ningún error de estado estable.

Otras pruebas de robustez incluyeron las ráfagas de viento de hasta 5 m/s y el ruido de sensores típicos de MEMS IMUs de bajo costo. El controlador mantuvo la estabilidad en todos los casos, con la desviación de ángulo de giro máximo que quedaba bajo 1,5 grados. El criterio de Routh-Hurwitz proporciona así no sólo estabilidad, sino también una base de referencia para un rendimiento robusto.

Consideraciones de la aplicación práctica

Mientras que el criterio de Routh-Hurwitz es una poderosa herramienta analítica, tiene limitaciones. Se aplica sólo a los sistemas lineales de tiempo invariable, por lo que el modelo linealizado debe ser válido alrededor del punto de funcionamiento. Para maniobras agresivas, efectos no lineales (por ejemplo, saturación de actuadores, par giroscópico) puede causar degradación de la estabilidad.

Además, la implementación digital introduce retrasos de muestreo y errores de cuantificación. Estos pueden ser modelados como un lag de fase extra, que reduce el margen de fase eficaz. El criterio todavía se puede aplicar incluyendo el retraso de control digital como un polo extra en el polinomio característico. Para nuestro quadrotor, que ejecuta el lazo de control a 500 Hz mantuvo el retraso inferior a 2 ms, que no alteró significativamente los resultados de la matriz de Routh.

Conclusión

El criterio de Routh-Hurwitz sigue siendo un primer paso indispensable en el diseño del sistema de control para los drones de quadrotor. Este estudio demostró cómo derivar el polinomio característico del eje de rodillos de un quadrotor, construir la matriz de Routh y extraer restricciones algebraicas que definen regiones de ganancia estable. El método permitió el rápido rechazo de conjuntos de parámetros inestables sin una gran simulación o prototipado.

Para más información sobre el criterio de Routh-Hurwitz, vea el artículo completo de Wikipedia. Una excelente referencia sobre la dinámica del quadrotor es el documento de B. Corke en Robotics and Autonomous Systems. Para una teoría de control más profunda, consulte el sitio de control de Michigan