LQR

LQR Controller

Advanced
Live-Beispiel starten Kostenlos · ohne Anmeldung · läuft im Browser

Der LQRController-Block ist ein linear-quadratischer Regler. Sie geben ihm ein Zustandsraummodell der Strecke (A\mathbf{A}, B\mathbf{B}) und zwei Gewichtungen: Q\mathbf{Q}, was eine Abweichung jedes Zustands kostet, und RR, was Stellaufwand kostet. Der Block berechnet die optimale Zustandsrückführung K\mathbf{K} selbst und gibt u=−Kxu = -\mathbf{K}\mathbf{x} aus. Wo ein PID-Regelkreis auf ein einziges Fehlersignal schaut, nutzt LQR alle Zustände zugleich — deshalb kann er ein inverses Pendel balancieren und den Wagen in derselben Bewegung zurückfahren.

Verbinden Sie jeden Zustand der Strecke mit den Eingängen x0,x1,…x_0, x_1, \dots in der Reihenfolge von A\mathbf{A}; höchstens sechs Zustände. Um auf einen Sollwert statt auf null zu regeln, führen Sie die Abweichung xi−xi,refx_i - x_{i,\text{ref}} auf diesen Eingang. Die entworfenen Verstärkungen liegen an den optionalen Ausgängen K0…K5K_0 \dots K_5, und Valid meldet, ob überhaupt ein Entwurf möglich war.

Mathematisches Modell

Beim kontinuierlichen Entwurf minimiert der Block

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

Die optimale Verstärkung folgt aus der stabilisierenden Lösung X\mathbf{X} der kontinuierlichen algebraischen Riccati-Gleichung:

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}

Beim diskreten Entwurf (x[k+1]=Ax[k]+Bu[k]\mathbf{x}[k+1] = \mathbf{A}\mathbf{x}[k] + \mathbf{B}u[k], Kosten ∑xTQx+Ru2\sum \mathbf{x}^T\mathbf{Q}\mathbf{x} + Ru^2) löst er die diskrete Riccati-Gleichung:

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}

Der Ausgang ist u=−Kxu = -\mathbf{K}\mathbf{x}. Ein Entwurf wird nur angenommen, wenn der geschlossene Kreis A−BK\mathbf{A} - \mathbf{B}\mathbf{K} stabil ist.

Ein- & Ausgänge

Direction ID Label Typ 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

Parameter

Parameter Label Typ Standardwert Beschreibung
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

Anwendungsbeispiele

Einfacher LQRController

Ein Doppelintegrator (ein Wagen ohne Reibung, A=[0 1; 0 0]\mathbf{A} = [0\ 1;\ 0\ 0], B=[0; 1]\mathbf{B} = [0;\ 1]) startet 1 m vom Ursprung entfernt. Mit Q=I\mathbf{Q} = \mathbf{I} und R=1R = 1 entwirft der Block K=[1, 3]\mathbf{K} = [1,\ \sqrt{3}] und fährt den Wagen ohne Überschwingen zurück.

Inverses Pendel: PID gegen LQR

Die Vorlage _Inverses Pendel: PID vs. LQR_ balanciert dasselbe Pendel zweimal: einmal mit einem PID nur auf den Winkel, einmal mit diesem Block auf allen vier Zuständen. Der PID hält den Stab aufrecht, lässt den Wagen aber davonrollen; LQR fängt den Stoß ab und stellt den Wagen auf seinen Sollwert.

Hinweise & Best Practices

  • Einstellen: Beginnen Sie mit Q=I\mathbf{Q} = \mathbf{I} und R=1R = 1 und erhöhen Sie dann den Q\mathbf{Q}-Eintrag des wichtigsten Zustands. Q\mathbf{Q} und RR gemeinsam zu skalieren ändert nichts.
  • Wenn Valid = 0 ist: Die Größen von A\mathbf{A}, B\mathbf{B} und Q\mathbf{Q} passen nicht, R≤0R \le 0, oder die Strecke hat eine instabile Mode, die der Eingang nicht erreicht. Keine Verstärkung kann eine solche Strecke stabilisieren, daher gibt der Block u=0u = 0 aus statt einer Verstärkung, die versagen würde.
  • Das Modell ist Ihres: LQR ist optimal für die eingetippten A\mathbf{A} und B\mathbf{B}, nicht für die verdrahtete Strecke. Verwenden Sie für beide dieselben Diagrammvariablen.
  • Alle Zustände nötig: LQR führt jeden Zustand zurück. Sind nur einige messbar, schätzen Sie den Rest mit einem KalmanFilter (zusammen: LQG-Regelung).
  • Entwurf wird zwischengespeichert: K\mathbf{K} wird einmal pro Lauf berechnet und nur neu, wenn sich A\mathbf{A}, B\mathbf{B}, Q\mathbf{Q} oder RR ändern; pro Schritt kostet der Block ein Skalarprodukt.
  • Ein Eingang: Der Block entwirft für eine Stellgröße. Eine Strecke mit mehreren Eingängen braucht eine Verstärkungszeile pro Eingang.

Verwandte Blöcke