LQR Controller
AdvancedDer LQRController-Block ist ein linear-quadratischer Regler. Sie geben ihm ein Zustandsraummodell der Strecke (, ) und zwei Gewichtungen: , was eine Abweichung jedes Zustands kostet, und , was Stellaufwand kostet. Der Block berechnet die optimale Zustandsrückführung selbst und gibt 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 in der Reihenfolge von ; höchstens sechs Zustände. Um auf einen Sollwert statt auf null zu regeln, führen Sie die Abweichung auf diesen Eingang. Die entworfenen Verstärkungen liegen an den optionalen Ausgängen , und Valid meldet, ob überhaupt ein Entwurf möglich war.
Mathematisches Modell
Beim kontinuierlichen Entwurf minimiert der Block
Die optimale Verstärkung folgt aus der stabilisierenden Lösung der kontinuierlichen algebraischen Riccati-Gleichung:
Beim diskreten Entwurf (, Kosten ) löst er die diskrete Riccati-Gleichung:
Der Ausgang ist . Ein Entwurf wird nur angenommen, wenn der geschlossene Kreis 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, , ) startet 1 m vom Ursprung entfernt. Mit und entwirft der Block 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 und und erhöhen Sie dann den -Eintrag des wichtigsten Zustands. und gemeinsam zu skalieren ändert nichts.
- Wenn Valid = 0 ist: Die Größen von , und passen nicht, , oder die Strecke hat eine instabile Mode, die der Eingang nicht erreicht. Keine Verstärkung kann eine solche Strecke stabilisieren, daher gibt der Block aus statt einer Verstärkung, die versagen würde.
- Das Modell ist Ihres: LQR ist optimal für die eingetippten und , 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: wird einmal pro Lauf berechnet und nur neu, wenn sich , , oder ä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
- StateSpace" class="bw-link">StateSpace
- DiscreteStateSpace" class="bw-link">DiscreteStateSpace
- KalmanFilter" class="bw-link">KalmanFilter
- PIDController" class="bw-link">PIDController