LQR

LQR Controller

Advanced
Ejecutar el ejemplo en vivo Gratis · sin registro · funciona en tu navegador

El bloque LQRController es un regulador lineal cuadrático. Le da un modelo de estado de la planta (A\mathbf{A}, B\mathbf{B}) y dos pesos: Q\mathbf{Q}, cuánto cuesta la desviación de cada estado, y RR, cuánto cuesta el esfuerzo de control. El bloque calcula por sí mismo la ganancia óptima de realimentación de estado K\mathbf{K} y entrega u=−Kxu = -\mathbf{K}\mathbf{x}. Donde un lazo PID mira una sola señal de error, el LQR usa todos los estados a la vez — por eso puede equilibrar un péndulo invertido y devolver el carro a su sitio en el mismo movimiento.

Conecte cada estado de la planta a las entradas x0,x1,…x_0, x_1, \dots en el orden de A\mathbf{A}; hasta seis estados. Para regular hacia una consigna en lugar de hacia cero, introduzca la desviación xi−xi,refx_i - x_{i,\text{ref}} en esa entrada. Las ganancias diseñadas aparecen en las salidas opcionales K0…K5K_0 \dots K_5, y Valid indica si se pudo hacer un diseño.

Modelo Matemático

En el diseño continuo el bloque minimiza

J=∫0∞(xTQx+Ru2)dt,x˙=Ax+BuJ = \int_0^\infty \left( \mathbf{x}^T \mathbf{Q} \mathbf{x} + R u^2 \right) dt, \qquad \dot{\mathbf{x}} = \mathbf{A}\mathbf{x} + \mathbf{B}u

La ganancia óptima se obtiene de la solución estabilizante X\mathbf{X} de la ecuación algebraica de Riccati continua:

ATX+XA−XBR−1BTX+Q=0,K=R−1BTX\mathbf{A}^T\mathbf{X} + \mathbf{X}\mathbf{A} - \mathbf{X}\mathbf{B}R^{-1}\mathbf{B}^T\mathbf{X} + \mathbf{Q} = 0, \qquad \mathbf{K} = R^{-1}\mathbf{B}^T\mathbf{X}

En el diseño discreto (x[k+1]=Ax[k]+Bu[k]\mathbf{x}[k+1] = \mathbf{A}\mathbf{x}[k] + \mathbf{B}u[k], coste ∑xTQx+Ru2\sum \mathbf{x}^T\mathbf{Q}\mathbf{x} + Ru^2) resuelve la ecuación de Riccati discreta:

X=ATXA−ATXB (R+BTXB)−1BTXA+Q,K=(R+BTXB)−1BTXA\mathbf{X} = \mathbf{A}^T\mathbf{X}\mathbf{A} - \mathbf{A}^T\mathbf{X}\mathbf{B}\,(R + \mathbf{B}^T\mathbf{X}\mathbf{B})^{-1}\mathbf{B}^T\mathbf{X}\mathbf{A} + \mathbf{Q}, \qquad \mathbf{K} = (R + \mathbf{B}^T\mathbf{X}\mathbf{B})^{-1}\mathbf{B}^T\mathbf{X}\mathbf{A}

La salida es u=−Kxu = -\mathbf{K}\mathbf{x}. Un diseño solo se acepta si el lazo cerrado A−BK\mathbf{A} - \mathbf{B}\mathbf{K} es estable.

Entradas y Salidas

Direction ID Label Tipo Status
→ In in1 x₀ number Required
→ In in2 x₁ number Optional
→ In in3 x₂ number Optional
→ In in4 x₃ number Optional
→ In in5 x₄ number Optional
→ In in6 x₅ number Optional
← Out out u number Output
← Out valid Valid number Output
← Out k_0 K₀ number Output
← Out k_1 K₁ number Output
← Out k_2 K₂ number Output
← Out k_3 K₃ number Output
← Out k_4 K₄ number Output
← Out k_5 K₅ number Output

Parámetros

Parámetros Label Tipo Por defecto Descripción
design Design select continuous Continuous: dx/dt = A·x + B·u, minimising ∫(xᵀQx + R·u²)dt. Discrete: x[k+1] = A·x[k] + B·u[k], minimising Σ(xᵀQx + R·u²); use with a discrete plant
A A (n×n) matrix 0 1; 0 0 State matrix, rows separated by ;. Up to six states
B B (n×1) matrix 0; 1 Input matrix, one entry per state
Q Q matrix 1 0; 0 1 State weight: n numbers for the diagonal, or the full n×n matrix. A larger entry makes that state settle faster
R R number 1 Input weight. Larger R means gentler control effort; it must be above 0

Ejemplos de Uso

LQRController básico

Un doble integrador (un carro sin fricción, A=[0 1; 0 0]\mathbf{A} = [0\ 1;\ 0\ 0], B=[0; 1]\mathbf{B} = [0;\ 1]) parte a 1 m del origen. Con Q=I\mathbf{Q} = \mathbf{I} y R=1R = 1 el bloque diseña K=[1, 3]\mathbf{K} = [1,\ \sqrt{3}] y devuelve el carro sin sobreoscilación.

Péndulo invertido: PID frente a LQR

La plantilla _Péndulo invertido: PID frente a LQR_ equilibra el mismo péndulo dos veces: una con un PID solo sobre el ángulo y otra con este bloque sobre los cuatro estados. El PID mantiene la varilla erguida pero deja que el carro se escape; el LQR absorbe el empujón y lleva el carro a su consigna.

Observaciones y Buenas Prácticas

  • Ajuste: empiece con Q=I\mathbf{Q} = \mathbf{I} y R=1R = 1 y luego aumente el elemento de Q\mathbf{Q} del estado que más importa. Escalar Q\mathbf{Q} y RR juntos no cambia nada.
  • Cuando Valid = 0: los tamaños de A\mathbf{A}, B\mathbf{B} y Q\mathbf{Q} no encajan, R≤0R \le 0, o la planta tiene un modo inestable que la entrada no alcanza. Ninguna ganancia puede estabilizar esa planta, así que el bloque entrega u=0u = 0 en lugar de una ganancia que fallaría.
  • El modelo es suyo: el LQR es óptimo para las A\mathbf{A} y B\mathbf{B} que escribe, no para la planta que conecta. Use las mismas variables del diagrama en ambos.
  • Se necesitan todos los estados: el LQR realimenta cada estado. Si solo puede medir algunos, estime el resto con un KalmanFilter (juntos: control LQG).
  • El diseño se guarda: K\mathbf{K} se calcula una vez por simulación y solo se recalcula si cambian A\mathbf{A}, B\mathbf{B}, Q\mathbf{Q} o RR; cada paso cuesta un producto escalar.
  • Una sola entrada: el bloque diseña para una entrada de control. Una planta con varias entradas necesita una fila de ganancias por entrada.

Bloques Relacionados