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 MM rueda sobre un raíl horizontal, frenado por una fricción viscosa bb. Una varilla de masa mm está articulada al carro y puede girar en el plano vertical. La fuerza uu se aplica horizontalmente al carro: es lo único que controlamos. El ángulo θ\theta se mide desde la vertical hacia arriba, de modo que θ=0\theta = 0 es el equilibrio y un θ\theta positivo significa que la varilla se ha inclinado hacia un lado.

SímboloSignificadoValor
MMmasa del carro0.5 kg0.5\ \text{kg}
mmmasa del péndulo0.2 kg0.2\ \text{kg}
bbcoeficiente de fricción del carro0.1 N⋅s/m0.1\ \text{N}\cdot\text{s/m}
llpivote a centro de masa0.3 m0.3\ \text{m}
IIinercia de la varilla respecto a su centro13ml2=0.006 kg⋅m2\tfrac{1}{3}ml^2 = 0.006\ \text{kg}\cdot\text{m}^2
ggaceleración de la gravedad9.81 m/s29.81\ \text{m/s}^2

Ecuaciones del movimiento

Se toman el carro y la varilla por separado y la articulación transmite fuerzas entre ellos. Llamamos NN a la fuerza horizontal en la articulación y PP a la vertical.

Segunda ley de Newton a lo largo del raíl, solo para el carro:

Mx¨+bx˙+N=uM\ddot{x} + b\dot{x} + N = u

El centro de masa de la varilla está horizontalmente en x−lsin⁡θx - l\sin\theta (un θ\theta positivo inclina la varilla hacia atrás, hacia −x-x); derivando dos veces se obtiene la fuerza horizontal que necesita la varilla:

N=mx¨−mlθ¨cos⁡θ+mlθ˙2sin⁡θN = m\ddot{x} - ml\ddot{\theta}\cos\theta + ml\dot{\theta}^2\sin\theta

Al sustituir desaparece NN y queda la primera ecuación del movimiento:

(M+m)x¨+bx˙−mlθ¨cos⁡θ+mlθ˙2sin⁡θ=u(M + m)\ddot{x} + b\dot{x} - ml\ddot{\theta}\cos\theta + ml\dot{\theta}^2\sin\theta = u

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:

(I+ml2)θ¨−mglsin⁡θ=mlx¨cos⁡θ(I + ml^2)\ddot{\theta} - mgl\sin\theta = ml\ddot{x}\cos\theta

Dos ecuaciones no lineales acopladas. Fíjate en el signo del término de gravedad: pasado al lado derecho es +mglsin⁡θ+mgl\sin\theta cuando θ\theta se mide desde arriba, así que empuja θ¨\ddot\theta hacia donde ya apunta θ\theta; justo lo que hace que este sistema caiga en vez de volver.

Linealización alrededor de la vertical

Equilibrar significa quedarse cerca de θ=0\theta = 0. Para ángulos pequeños, sin⁡θ≈θ\sin\theta \approx \theta, cos⁡θ≈1\cos\theta \approx 1, y θ˙2\dot{\theta}^2 es pequeño de segundo orden y desaparece:

(I+ml2)θ¨−mglθ=mlx¨(I + ml^2)\ddot{\theta} - mgl\theta = ml\ddot{x}

(M+m)x¨+bx˙−mlθ¨=u(M + m)\ddot{x} + b\dot{x} - ml\ddot{\theta} = u

Aplicando Laplace con condiciones iniciales nulas y eliminando X(s)X(s) se obtiene la función de transferencia de la fuerza al ángulo del péndulo:

Θ(s)U(s)=mlq ss3+b(I+ml2)qs2−(M+m)mglqs−bmglq\frac{\Theta(s)}{U(s)} = \frac{\dfrac{ml}{q}\,s}{s^3 + \dfrac{b(I + ml^2)}{q}s^2 - \dfrac{(M+m)mgl}{q}s - \dfrac{bmgl}{q}}

donde

q=(M+m)(I+ml2)−(ml)2q = (M + m)(I + ml^2) - (ml)^2

Con los valores anteriores, q=0.0132q = 0.0132 y la función de transferencia queda

Θ(s)U(s)=4.54545 ss3+0.18182 s2−31.21364 s−4.45909\frac{\Theta(s)}{U(s)} = \frac{4.54545\,s}{s^3 + 0.18182\,s^2 - 31.21364\,s - 4.45909}

Por qué se cae

Esos dos signos menos del denominador lo cuentan todo. Al factorizarlo, los polos son

s=+5.568,s=−5.607,s=−0.143s = +5.568,\qquad s = -5.607,\qquad s = -0.143

Uno está en el semiplano derecho. Cualquier perturbación, por pequeña que sea, excita una respuesta que crece como e5.568te^{5.568t}: el ángulo se duplica aproximadamente cada 0.120.12 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:

x˙=Ax+Bu,x=[xx˙θθ˙]T\dot{\mathbf{x}} = A\mathbf{x} + Bu,\qquad \mathbf{x} = \begin{bmatrix} x & \dot{x} & \theta & \dot{\theta} \end{bmatrix}^\mathsf{T}

A=[01000−(I+ml2)bqm2gl2q000010−mlbqmgl(M+m)q0],B=[0I+ml2q0mlq]A = \begin{bmatrix} 0 & 1 & 0 & 0 \\ 0 & -\dfrac{(I+ml^2)b}{q} & \dfrac{m^2gl^2}{q} & 0 \\ 0 & 0 & 0 & 1 \\ 0 & -\dfrac{mlb}{q} & \dfrac{mgl(M+m)}{q} & 0 \end{bmatrix},\qquad B = \begin{bmatrix} 0 \\ \dfrac{I+ml^2}{q} \\ 0 \\ \dfrac{ml}{q} \end{bmatrix}

Sus polos son los tres anteriores más uno en s=0s = 0: el carro, que no tiene ninguna posición preferida. Escrita completa, la función de transferencia del ángulo según este modelo es

Θ(s)U(s)=4.545 s2s (s3+0.182 s2−31.21 s−4.459)\frac{\Theta(s)}{U(s)} = \frac{4.545\,s^2}{s\,(s^3 + 0.182\,s^2 - 31.21\,s - 4.459)}

y una ss 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 θ\theta, el polo del carro es invisible.

La posición del carro tiene ceros propios, en s=±mgl/(I+ml2)=±4.95s = \pm\sqrt{mgl/(I+ml^2)} = \pm 4.95. 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 MM y AA y BB le siguen; el motor reconstruye las matrices del bloque sobre la marcha, sin reiniciar. CC 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 ±90°\pm 90° —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 10 N10\ \text{N} durante 0.1 s0.1\ \text{s} en t=0.2 st = 0.2\ \text{s} —un impulso de 1 N⋅s1\ \text{N}\cdot\text{s}—, 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 −θ-\theta. Cinco juegos de ganancias, cada uno medido durante 5 s5\ \text{s} con un tiempo de muestreo de 0.001 s0.001\ \text{s}:

KpK_pKiK_iKdK_dθ\theta picoen gradosdentro de 0.0050.005 rad
1001200.04110.04112.35°2.35°0.750.75 s
1000200.04110.04112.35°2.35°0.750.75 s
3205.50.13960.13968.00°8.00°1.051.05 s
501100.08190.08194.69°4.69°0.940.94 s
2001400.02050.02051.17°1.17°0.590.59 s

La acción proporcional sola es un muelle. Con Kp=100K_p = 100 y nada más, los polos en lazo cerrado quedan en −0.10±20.6j-0.10 \pm 20.6j: la varilla oscila a través de la vertical a 3.3 Hz3.3\ \text{Hz} con un factor de amortiguamiento de 0.0050.005, y no para. Un tercer polo en +0.011+0.011 sigue siendo inestable, lentamente.

La acción derivativa quita la energía. Responde a θ˙\dot\theta, a lo rápido que cae la varilla, y por eso empieza a empujar cuando la varilla está aún casi vertical. Con Kd=20K_d = 20 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, −bmgl/q+Ki ml/q-bmgl/q + K_i\,ml/q, es negativo y un polo se queda en +0.011+0.011. Ki=1K_i = 1 (la elección de CTMS) lo lleva a −0.0002-0.0002: 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 KpK_p, KiK_i y KdK_d puede mover el polo en s=0s = 0.

Realimentación de estado: el carro vuelve

Se miden los cuatro estados y se realimenta cada uno:

u=−K [x−xrefx˙θθ˙]Tu = -K\,\begin{bmatrix} x - x_\text{ref} & \dot{x} & \theta & \dot{\theta} \end{bmatrix}^\mathsf{T}

El modelo usa el diseño LQR de CTMS, que minimiza ∫(xTQ x+u2) dt\int (\mathbf{x}^\mathsf{T} Q\,\mathbf{x} + u^2)\,dt con Q=diag⁡(5000,0,100,0)Q = \operatorname{diag}(5000, 0, 100, 0):

K=[−70.7−37.8105.620.9]K = \begin{bmatrix} -70.7 & -37.8 & 105.6 & 20.9 \end{bmatrix}

lo que sitúa los polos en lazo cerrado en −8.49±7.93j-8.49 \pm 7.93j y −4.76±0.83j-4.76 \pm 0.83j. Tras el empujón la varilla alcanza un máximo de 5.4°5.4° y el carro vuelve al centro. Un escalón de consigna de 0.2 m0.2\ \text{m} en t=1.5 st = 1.5\ \text{s} tarda alrededor de un segundo, con una inclinación máxima de 9°9° y 14 N14\ \text{N}, y empieza con el carro rodando 58 mm58\ \text{mm} en sentido contrario. Es el cero en +4.95+4.95: 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 L(s)=K(sI−A)−1BL(s) = K(sI - A)^{-1}B cruza 0 dB0\ \text{dB} en 26.1 rad/s26.1\ \text{rad/s} con 61.3°61.3° de margen de fase. Un retardo de transporte (Delay) τd\tau_d no toca la magnitud y resta ωτd\omega\tau_d a la fase, así que el margen de retardo es

τmax=61.3°⋅π/18026.1 rad/s≈41 ms\tau_\text{max} = \frac{61.3° \cdot \pi/180}{26.1\ \text{rad/s}} \approx 41\ \text{ms}

Medido: 30 ms30\ \text{ms} suben la inclinación máxima de 9°9° a 13°13° y dejan 16°16° de margen; con 40 ms40\ \text{ms} oscila al límite; con 50 ms50\ \text{ms} 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 0.50.5 un cambio de consigna cuesta 0.9 N0.9\ \text{N}; con 1.51.5 cuesta 72 N72\ \text{N} y 21°21° de inclinación.
  • Combina velocidad 1.51.5 con 30 ms30\ \text{ms} de retardo. El controlador más rápido cruza a mayor frecuencia y solo tiene unos 28 ms28\ \text{ms} de margen de retardo: la varilla cae.
  • Pon el viento en 5 N5\ \text{N}. La varilla se mantiene vertical, pero el carro se detiene a unos 7 cm7\ \text{cm} de su consigna: en reposo el controlador debe contrarrestar con −5 N-5\ \text{N}, y la ganancia de posición solo lo hace con un error, F/kxF/k_x. Una acción integral sobre xx lo eliminaría.
  • Sube ll. 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: sin⁡θ≈θ\sin\theta \approx \theta se cumple con un error del 1%1\% hasta unos 14°14°. 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 E=12(I+ml2)θ˙2+mgl(cos⁡θ−1)E = \tfrac12 (I+ml^2)\dot\theta^2 + mgl(\cos\theta - 1) 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í (MM, mm, bb, ll) 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 g=9.81 m/s2g = 9.81\ \text{m/s}^2.

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 ±90∘\pm 90^\circ).
  • XYPlot: trayectoria en el plano de fase (θ\theta frente a θ˙\dot{\theta}).
  • 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.

Preguntas Frecuentes (FAQ)

Q: How do you linearize the equations of motion for an inverted pendulum cart around theta = 0?

The coupled nonlinear equations derived via Euler-Lagrange are (M+m)x¨+mLθ¨cos⁡θ−mLθ˙2sin⁡θ=F(M + m)\ddot{x} + m L \ddot{\theta}\cos\theta - m L \dot{\theta}^2\sin\theta = F and mLx¨cos⁡θ+(I+mL2)θ¨−mgLsin⁡θ=0m L \ddot{x}\cos\theta + (I + m L^2)\ddot{\theta} - m g L \sin\theta = 0. Linearizing around upright equilibrium x0=[0,0,0,0]Tx_0 = [0, 0, 0, 0]^T using small-angle approximations sin⁡θ≈θ\sin\theta \approx \theta, cos⁡θ≈1\cos\theta \approx 1, and dropping second-order velocities θ˙2≈0\dot{\theta}^2 \approx 0 yields the linear state-space system x˙=Ax+Bu\dot{x} = A x + B u with states x=[p,p˙,θ,θ˙]Tx = [p, \dot{p}, \theta, \dot{\theta}]^T. Here, denominator Jt=(M+m)(I+mL2)−(mL)2J_t = (M+m)(I+mL^2) - (mL)^2, producing an unstable open-loop pole at s=+(M+m)mgLJts = +\sqrt{\frac{(M+m)mgL}{J_t}}.

Q: Why is Full-State Feedback (LQR) superior to dual-PID loops for cart-pendulum stabilization?

The inverted cart-pendulum is an underactuated system (1 control force FF controls 2 degrees of freedom: cart position pp and pole angle θ\theta). Decentralized PID loops suffer from severe dynamic cross-talk: moving the cart forward requires accelerating backward first, introducing non-minimum phase right-half-plane zeros. Linear Quadratic Regulation (LQR) solves the continuous algebraic Riccati equation ATP+PA−PBR−1BTP+Q=0A^T P + P A - P B R^{-1} B^T P + Q = 0 to calculate optimal state gain matrix K=R−1BTPK = R^{-1} B^T P, coordinating cart positioning and balance simultaneously with guaranteed stability margins (≥60∘\ge 60^\circ phase margin).

Q: What happens when the cart actuator saturates, and how is this simulated in BlockWerk?

When required motor force exceeds physical limits ∣u∣>Fmax⁡|u| > F_{\max}, the linear control law loses control authority. If ∣θ∣>θcrit|\theta| > \theta_{\text{crit}}, gravitational torque mgLsin⁡θm g L \sin\theta exceeds the maximum recoverable horizontal torque Fmax⁡Lcos⁡θF_{\max} L \cos\theta, causing the pole to fall open-loop. In BlockWerk, inserting a Saturation block between the state-gain matrix KK and plant input BB dynamically clamps u(t)=clamp(u,−Fmax⁡,Fmax⁡)u(t) = \text{clamp}(u, -F_{\max}, F_{\max}), enabling engineers to accurately verify the maximum impulse disturbance before destabilization.

Simular en BlockWerk

Simulador interactivo en tu navegador — sin instalación, motor WebAssembly.

Simular en BlockWerk →