Péndulo invertido sobre un carro
Un péndulo colgado de un pivote es aburrido: lo empujas y vuelve. Pon el mismo péndulo de pie sobre un carro que solo puede moverse de lado y se convierte en el problema didáctico más claro de la ingeniería de control. El sistema no puede quedarse quieto por sí solo. Abandonado a sí mismo cae, y cae más rápido cuanto más ha caído ya. La única forma de mantenerlo arriba es mover aquello sobre lo que se apoya: atraparlo llevando el carro por debajo.
Por eso merece un caso práctico completo. Casi todas las ideas del control clásico aparecen aquí sin dónde esconderse: una planta inestable, un controlador que tiene que actuar antes de que crezca el error, la diferencia entre reaccionar a un error y anticiparlo, y el compromiso entre una respuesta rápida y una violenta.
El montaje físico
Un carro de masa rueda sobre un raíl horizontal, frenado por una fricción viscosa . Una varilla de masa está articulada al carro y puede girar en el plano vertical. La fuerza se aplica horizontalmente al carro: es lo único que controlamos. El ángulo se mide desde la vertical hacia arriba, de modo que es el equilibrio y un positivo significa que la varilla se ha inclinado hacia un lado.
| Símbolo | Significado | Valor |
|---|---|---|
| masa del carro | ||
| masa del péndulo | ||
| coeficiente de fricción del carro | ||
| pivote a centro de masa | ||
| inercia de la varilla respecto a su centro | ||
| aceleración de la gravedad |
Ecuaciones del movimiento
Se toman el carro y la varilla por separado y la articulación transmite fuerzas entre ellos. Llamamos a la fuerza horizontal en la articulación y a la vertical.
Segunda ley de Newton a lo largo del raíl, solo para el carro:
El centro de masa de la varilla está horizontalmente en (un positivo inclina la varilla hacia atrás, hacia ); derivando dos veces se obtiene la fuerza horizontal que necesita la varilla:
Al sustituir desaparece y queda la primera ecuación del movimiento:
Para la segunda se toman momentos respecto al centro de masa de la varilla. La gravedad actúa ahí, así que no aporta nada; solo cuentan las dos fuerzas de la articulación:
Dos ecuaciones no lineales acopladas. Fíjate en el signo del término de gravedad: pasado al lado derecho es cuando se mide desde arriba, así que empuja hacia donde ya apunta ; justo lo que hace que este sistema caiga en vez de volver.
Linealización alrededor de la vertical
Equilibrar significa quedarse cerca de . Para ángulos pequeños, , , y es pequeño de segundo orden y desaparece:
Aplicando Laplace con condiciones iniciales nulas y eliminando se obtiene la función de transferencia de la fuerza al ángulo del péndulo:
donde
Con los valores anteriores, y la función de transferencia queda
Por qué se cae
Esos dos signos menos del denominador lo cuentan todo. Al factorizarlo, los polos son
Uno está en el semiplano derecho. Cualquier perturbación, por pequeña que sea, excita una respuesta que crece como : el ángulo se duplica aproximadamente cada segundos. No es un artefacto del modelo. Es la varilla cayéndose, escrita en álgebra.
Ejecuta el diagrama con el controlador desconectado y verás exactamente eso: un empujón y luego una curva que sale por arriba de la gráfica y no vuelve nunca.
Toda la planta como un modelo de espacio de estados
La función de transferencia de arriba describe el ángulo, y solo el ángulo. Con el carro, el sistema linealizado tiene cuatro estados —posición y velocidad del carro, ángulo y velocidad angular de la varilla— y una entrada:
Sus polos son los tres anteriores más uno en : el carro, que no tiene ninguna posición preferida. Escrita completa, la función de transferencia del ángulo según este modelo es
y una se cancela. Esa cancelación es la razón por la que la función de transferencia de tercer orden era correcta, y también toda la razón por la que un controlador que solo ve el ángulo no puede devolver el carro: visto desde , el polo del carro es invisible.
La posición del carro tiene ceros propios, en . El del semiplano derecho importará más adelante.
Construirlo en BlockWerk
La planta es un único bloque StateSpace. Sus matrices no son decimales: cada elemento es una expresión de las variables del diagrama —mgl(M+m)/q, (I+ml^2)/q— que se evalúa al ejecutar el modelo. Mueve el deslizador de y y le siguen; el motor reconstruye las matrices del bloque sobre la marcha, sin reiniciar. es la identidad, así que el bloque tiene cuatro salidas, y_0 a y_3, una por estado.
A diferencia de las suites de simulación de escritorio que requieren gigabytes de instalación (mira nuestra comparativa alternativa a Simulink), BlockWerk resuelve este sistema inestable de cuarto orden directamente en el navegador con WebAssembly a 60 fps, en portátiles escolares sin instalar nada (mira control en Chromebook e iPad).
Todo lo demás cuelga de esas salidas. El ángulo pasa por una Saturation a —el suelo, del que el modelo lineal no sabe nada— hacia el osciloscopio y el controlador de solo ángulo. Los cuatro estados van a los bloques Gain de la realimentación de estado.
Perturbar el sistema
Aquí hay una trampa que conviene esquivar a propósito.
La prueba obvia es un escalón en la consigna. Para el ángulo no hace nada. La consigna es cero —vertical— y el modelo arranca en vertical, así que el error es cero, el controlador no da salida y la gráfica es una línea plana para siempre. Nada ha fallado; simplemente no hay nada que corregir.
Un problema de equilibrio no es un problema de seguimiento. Lo que se quiere preguntar es _«si algo lo golpea, ¿lo atrapa el controlador?»_. Así que la entrada es una perturbación sobre la fuerza: un empujón corto y luego nada. Este modelo usa un pulso rectangular de durante en —un impulso de —, construido con dos bloques Step que se anulan. Sin controlador, la varilla toca el suelo medio segundo después.
Un controlador que solo ve el ángulo
El primer lazo es un PIDController sobre . Cinco juegos de ganancias, cada uno medido durante con un tiempo de muestreo de :
| pico | en grados | dentro de rad | |||
|---|---|---|---|---|---|
| 100 | 1 | 20 | s | ||
| 100 | 0 | 20 | s | ||
| 32 | 0 | 5.5 | s | ||
| 50 | 1 | 10 | s | ||
| 200 | 1 | 40 | s |
La acción proporcional sola es un muelle. Con y nada más, los polos en lazo cerrado quedan en : la varilla oscila a través de la vertical a con un factor de amortiguamiento de , y no para. Un tercer polo en sigue siendo inestable, lentamente.
La acción derivativa quita la energía. Responde a , a lo rápido que cae la varilla, y por eso empieza a empujar cuando la varilla está aún casi vertical. Con la oscilación se extingue en menos de un segundo.
La acción integral mueve el último polo lento. Sin ella, el término constante del polinomio característico en lazo cerrado, , es negativo y un polo se queda en . (la elección de CTMS) lo lleva a : estable sobre el papel, con una constante de tiempo de unos 80 minutos.
Y durante todo ello el carro deriva. Tras el empujón se aleja a velocidad constante —medio metro en cinco segundos, dos metros en veinte—, porque ninguna elección de , y puede mover el polo en .
Realimentación de estado: el carro vuelve
Se miden los cuatro estados y se realimenta cada uno:
El modelo usa el diseño LQR de CTMS, que minimiza con :
lo que sitúa los polos en lazo cerrado en y . Tras el empujón la varilla alcanza un máximo de y el carro vuelve al centro. Un escalón de consigna de en tarda alrededor de un segundo, con una inclinación máxima de y , y empieza con el carro rodando en sentido contrario. Es el cero en : para inclinar la varilla hacia el objetivo, el carro debe primero apartarse de debajo, y la realimentación de estado mueve todos los polos pero ningún cero.
Retardo de transporte
Un lazo real tiene latencia: filtrado, muestreo, un bus, el accionamiento. Abriendo el lazo en la entrada del carro, la ganancia de lazo cruza en con de margen de fase. Un retardo de transporte (Delay) no toca la magnitud y resta a la fase, así que el margen de retardo es
Medido: suben la inclinación máxima de a y dejan de margen; con oscila al límite; con se pierde la varilla.
Cosas para probar
- El deslizador de velocidad escala los cuatro polos LQR por un mismo factor, y las ganancias se rediseñan para la planta que describen los demás deslizadores. Con un cambio de consigna cuesta ; con cuesta y de inclinación.
- Combina velocidad con de retardo. El controlador más rápido cruza a mayor frecuencia y solo tiene unos de margen de retardo: la varilla cae.
- Pon el viento en . La varilla se mantiene vertical, pero el carro se detiene a unos de su consigna: en reposo el controlador debe contrarrestar con , y la ganancia de posición solo lo hace con un error, . Una acción integral sobre lo eliminaría.
- Sube . Una varilla más larga cae más despacio —el polo inestable se acerca al origen—, y por eso los artistas de circo equilibran pértigas largas, no cortas.
Lo que este modelo deja fuera
El modelo es lineal, así que solo es honesto cerca de la vertical: se cumple con un error del hasta unos . El modelo lineal atrapará obedientemente una varilla desde ángulos de los que una real no volvería. Levantar la varilla desde la posición colgante necesita primero un controlador no lineal —el control por energía de Åström–Furuta lleva a cero; el aprendizaje por refuerzo es otra vía—, y cerca de arriba toma el relevo un controlador lineal como este.
Aquí el carro rueda sobre un raíl sin fin y el motor entrega cualquier fuerza que se le pida.
Fuentes
El juego de parámetros usado aquí (, , , ) y la elección de este sistema como ejemplo resuelto proceden de los Control Tutorials for MATLAB & Simulink (CTMS), de la Prof. Dawn Tilbury (University of Michigan) y el Prof. Bill Messner (Carnegie Mellon University), ampliados después por el Prof. Rick Hill (Detroit Mercy), JD Taylor (CMU) y el Prof. Shuvra Das (Detroit Mercy), con financiación de la NSF (subvención DUE 9554819) y MathWorks. CTMS tiene licencia CC BY-SA 4.0.
La deducción, el texto, el diagrama de bloques y cada valor medido de esta página son trabajo propio, obtenido con el motor de BlockWerk. Usamos .
Las ecuaciones del movimiento de un péndulo invertido sobre un carro son estándar y aparecen prácticamente en esta forma en la mayoría de los libros de control, entre ellos Modern Control Engineering de Ogata, Control Systems Engineering de Nise y Feedback Control of Dynamic Systems de Franklin, Powell y Emami-Naeini.
Ver también
- StateSpace: el modelo completo carro-péndulo de cuatro estados.
- Gain: implementación del vector de ganancias LQR de realimentación de estado completa.
- PIDController: lazo de estabilización solo sobre el ángulo.
- Delay: modelado de la latencia del actuador y del desfase.
- Saturation: límites mecánicos del ángulo (tope en el suelo a ).
- XYPlot: trayectoria en el plano de fase ( frente a ).
- uPlotDisplay: formas de onda temporales multicanal rápidas.
- Alternativa a Simulink: ingeniería de control en el navegador, sin trabas de licencias de escritorio.
- Control en Chromebook e iPad: simulaciones en tiempo real del péndulo invertido en hardware escolar portátil.
- Guía de simulación interactiva: solvers de Runge-Kutta, tiempos de muestreo y estabilidad.