LQR Controller
AdvancedLe bloc LQRController est un régulateur linéaire quadratique. Vous lui donnez un modèle d’état du procédé (, ) et deux pondérations : , le coût d’un écart sur chaque état, et , le coût de l’effort de commande. Le bloc calcule lui-même le gain de retour d’état optimal et fournit . Là où une boucle PID regarde un seul signal d’erreur, le LQR utilise tous les états à la fois — c’est ce qui lui permet d’équilibrer un pendule inversé et de ramener le chariot dans le même mouvement.
Reliez chaque état du procédé aux entrées dans l’ordre de ; six états au plus. Pour réguler vers une consigne plutôt que vers zéro, injectez l’écart sur cette entrée. Les gains calculés sont disponibles sur les sorties optionnelles , et Valid indique si une conception a pu être faite.
Modèle Mathématique
En conception continue, le bloc minimise
Le gain optimal découle de la solution stabilisante de l’équation algébrique de Riccati continue :
En conception discrète (, coût ), il résout l’équation de Riccati discrète :
La sortie vaut . Une conception n’est acceptée que si la boucle fermée est stable.
Entrées & Sorties
| 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 |
Paramètres
| Paramètres | Label | Type | Défaut | Description |
|---|---|---|---|---|
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 |
Exemples d'Utilisation
LQRController de base
Un double intégrateur (un chariot sans frottement, , ) part à 1 m de l’origine. Avec et , le bloc calcule et ramène le chariot sans dépassement.
Pendule inversé : PID ou LQR
Le modèle _Pendule inversé : PID ou LQR_ équilibre deux fois le même pendule : une fois avec un PID sur l’angle seul, une fois avec ce bloc sur les quatre états. Le PID garde la tige droite mais laisse filer le chariot ; le LQR absorbe la poussée et ramène le chariot à sa consigne.
Remarques & Bonnes Pratiques
- Réglage : commencez avec et , puis augmentez l’élément de de l’état le plus important. Multiplier et par le même facteur ne change rien.
- Quand Valid = 0 : les tailles de , et ne concordent pas, , ou le procédé a un mode instable que l’entrée ne peut pas atteindre. Aucun gain ne peut stabiliser un tel procédé ; le bloc fournit donc plutôt qu’un gain voué à l’échec.
- Le modèle est le vôtre : le LQR est optimal pour les et saisis, pas pour le procédé câblé. Utilisez les mêmes variables du diagramme pour les deux.
- Tous les états nécessaires : le LQR reboucle chaque état. Si seuls certains sont mesurables, estimez les autres avec un KalmanFilter (ensemble : commande LQG).
- Conception mémorisée : est calculé une fois par simulation et recalculé seulement si , , ou changent ; chaque pas ne coûte qu’un produit scalaire.
- Une seule entrée : le bloc conçoit pour une seule commande. Un procédé à plusieurs entrées demande une ligne de gains par entrée.
Composants Associés
- StateSpace" class="bw-link">StateSpace
- DiscreteStateSpace" class="bw-link">DiscreteStateSpace
- KalmanFilter" class="bw-link">KalmanFilter
- PIDController" class="bw-link">PIDController