LQR Controller
AdvancedEl bloque LQRController es un regulador lineal cuadrático. Le da un modelo de estado de la planta (, ) y dos pesos: , cuánto cuesta la desviación de cada estado, y , cuánto cuesta el esfuerzo de control. El bloque calcula por sí mismo la ganancia óptima de realimentación de estado y entrega . 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 en el orden de ; hasta seis estados. Para regular hacia una consigna en lugar de hacia cero, introduzca la desviación en esa entrada. Las ganancias diseñadas aparecen en las salidas opcionales , y Valid indica si se pudo hacer un diseño.
Modelo Matemático
En el diseño continuo el bloque minimiza
La ganancia óptima se obtiene de la solución estabilizante de la ecuación algebraica de Riccati continua:
En el diseño discreto (, coste ) resuelve la ecuación de Riccati discreta:
La salida es . Un diseño solo se acepta si el lazo cerrado 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, , ) parte a 1 m del origen. Con y el bloque diseña 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 y y luego aumente el elemento de del estado que más importa. Escalar y juntos no cambia nada.
- Cuando Valid = 0: los tamaños de , y no encajan, , o la planta tiene un modo inestable que la entrada no alcanza. Ninguna ganancia puede estabilizar esa planta, así que el bloque entrega en lugar de una ganancia que fallaría.
- El modelo es suyo: el LQR es óptimo para las y 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: se calcula una vez por simulación y solo se recalcula si cambian , , o ; 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
- StateSpace" class="bw-link">StateSpace
- DiscreteStateSpace" class="bw-link">DiscreteStateSpace
- KalmanFilter" class="bw-link">KalmanFilter
- PIDController" class="bw-link">PIDController