LQR

LQR Controller

Advanced
Start het live voorbeeld Gratis · geen account · draait in je browser

Het LQRController-blok is een lineair-kwadratische regelaar. Je geeft het een toestandsmodel van het proces (A\mathbf{A}, B\mathbf{B}) en twee gewichten: Q\mathbf{Q}, wat een afwijking van elke toestand kost, en RR, wat stuurinspanning kost. Het blok berekent zelf de optimale toestandsterugkoppeling K\mathbf{K} en geeft u=−Kxu = -\mathbf{K}\mathbf{x}. Waar een PID-lus naar één foutsignaal kijkt, gebruikt LQR alle toestanden tegelijk — daardoor kan het een omgekeerde slinger balanceren én het karretje in dezelfde beweging terugzetten.

Verbind elke toestand van het proces met de ingangen x0,x1,…x_0, x_1, \dots in de volgorde van A\mathbf{A}; maximaal zes toestanden. Om naar een setpoint te regelen in plaats van naar nul, voer je de afwijking xi−xi,refx_i - x_{i,\text{ref}} in op die ingang. De ontworpen versterkingen staan op de optionele uitgangen K0…K5K_0 \dots K_5, en Valid meldt of er überhaupt een ontwerp gemaakt kon worden.

Wiskundig Model

Bij het continue ontwerp minimaliseert het blok

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

De optimale versterking volgt uit de stabiliserende oplossing X\mathbf{X} van de continue algebraïsche Riccati-vergelijking:

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}

Bij het discrete ontwerp (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) lost het de discrete Riccati-vergelijking op:

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}

De uitgang is u=−Kxu = -\mathbf{K}\mathbf{x}. Een ontwerp wordt alleen geaccepteerd als de gesloten lus A−BK\mathbf{A} - \mathbf{B}\mathbf{K} stabiel is.

Ingangen & Uitgangen

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

Parameters

Parameters Label Type Standaard Beschrijving
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

Gebruiksvoorbeelden

Basis-LQRController

Een dubbele integrator (een karretje zonder wrijving, A=[0 1; 0 0]\mathbf{A} = [0\ 1;\ 0\ 0], B=[0; 1]\mathbf{B} = [0;\ 1]) start 1 m van de oorsprong. Met Q=I\mathbf{Q} = \mathbf{I} en R=1R = 1 ontwerpt het blok K=[1, 3]\mathbf{K} = [1,\ \sqrt{3}] en brengt het karretje zonder doorschot terug.

Omgekeerde slinger: PID tegenover LQR

De template _Omgekeerde slinger: PID vs LQR_ balanceert dezelfde slinger twee keer: één keer met een PID op alleen de hoek, één keer met dit blok op alle vier de toestanden. De PID houdt de staaf rechtop maar laat het karretje wegrijden; LQR vangt de duw op en zet het karretje op zijn setpoint.

Opmerkingen & Best Practices

  • Afstemmen: begin met Q=I\mathbf{Q} = \mathbf{I} en R=1R = 1 en verhoog dan het Q\mathbf{Q}-getal van de toestand die het meest telt. Q\mathbf{Q} en RR samen schalen verandert niets.
  • Als Valid = 0 is: de afmetingen van A\mathbf{A}, B\mathbf{B} en Q\mathbf{Q} passen niet, R≤0R \le 0, of het proces heeft een instabiele modus die de ingang niet kan bereiken. Geen versterking kan zo'n proces stabiliseren, dus het blok geeft u=0u = 0 in plaats van een versterking die zou falen.
  • Het model is van jou: LQR is optimaal voor de A\mathbf{A} en B\mathbf{B} die je intypt, niet voor het proces dat je bedraadt. Gebruik voor beide dezelfde diagramvariabelen zodat ze niet uit elkaar kunnen lopen.
  • Alle toestanden nodig: LQR koppelt elke toestand terug. Als je er maar een paar kunt meten, schat je de rest met een KalmanFilter (samen: LQG-regeling).
  • Ontwerp wordt bewaard: K\mathbf{K} wordt eenmaal per run berekend en alleen opnieuw als A\mathbf{A}, B\mathbf{B}, Q\mathbf{Q} of RR verandert; per stap kost het blok één inproduct.
  • Eén ingang: het blok ontwerpt voor één stuuringang. Een proces met meerdere ingangen heeft per ingang een versterkingsrij nodig.

Gerelateerde Componenten