Étude de cas : Appliquer Routh-hurwitz pour stabiliser un système de contrôle des drones Quadrotor

Dans les systèmes de contrôle modernes, la stabilité est la pierre angulaire d'un fonctionnement sûr et prévisible. Nulle part, cela n'est plus évident que dans les drones quadroteurs, où l'instabilité peut entraîner une défaillance catastrophique en quelques secondes.Cette étude de cas démontre l'application pratique du critère Routh-Hurwitz pour analyser et stabiliser le système de contrôle d'un drone quadroteur.

Dynamique du Quadrotor et architecture de contrôle

Un quadritor est un système non linéaire sous-actué et très couplé. Son mouvement est commandé par la variation des vitesses de quatre rotors, qui génèrent poussée et couple. Pour l'analyse de stabilité, le système est typiquement linéarisé autour d'un régime de vol stationnaire, donnant un ensemble d'équations différentielles de second ordre découplées pour le roulis, le pas, la lacet et l'altitude. Le système de contrôle emploie généralement des contrôleurs proportionnels-intégraux-dérivatifs (PID) pour chaque axe, les boucles de rétroaction étant fermées autour de l'assiette et les mesures de vitesse angulaires d'une unité de mesure d'inertie (IMU).

Modèle linéaire pour axe de roulement

Considérez la dynamique du rouleau. L'équation linéaire du mouvement est :

où est l'angle de roulis, est le moment d'inertie, est le dérivé d'amortissement aérodynamique, et est le dérivé de commande représentant le couple produit par la poussée différentielle.

La substitution et la formation de la fonction de transfert en boucle fermée donne un polynôme caractéristique de l'ordre trois (ou plus si la dynamique du capteur est incluse).

Le critère de Routh-Hurwitz nous permet alors d'analyser le signe des parties réelles des racines sans trouver explicitement de racine.

Le critère de Routh-Hurwitz : un essai systématique de stabilité

Développé indépendamment par Edward John Routh et Adolf Hurwitz, le critère Routh-Hurwitz fournit une condition nécessaire et suffisante pour la stabilité des systèmes linéaires invariants dans le temps. Il utilise les coefficients du polynôme caractéristique pour construire un tableau (le tableau Routh). Le nombre de changements de signe dans la première colonne de ce tableau équivaut au nombre de racines avec des parties réelles positives. Pour un système stable, toutes les entrées dans la première colonne doivent avoir le même signe (généralement positif).

Construction de la galerie Routh

Étant donné un polynôme , le tableau Routh est construit ligne par ligne:

Si un élément de la première colonne devient zéro, une manipulation spéciale est nécessaire (remplacez avec un petit épsilon ou utilisez la méthode polynôme auxiliaire). Si une ligne entière devient zéro, le polynôme a des racines symétriques, et le tableau est poursuivi à l'aide d'un polynôme auxiliaire.

Conditions de stabilité des systèmes de troisième commande

Pour un polynôme cubique , les conditions de Routh-Hurwitz se simplifient pour:

Cette règle simple est souvent utilisée comme un contrôle rapide avant de construire le tableau complet.

Application au système de contrôle de la roue Quadrotor

Pour notre étude de cas sur le quadritor, le polynôme caractéristique de l'axe de roulis, y compris les gains du contrôleur PID et la dynamique du rotor (modulé comme un décalage de premier ordre avec la constante de temps τ), a été dérivé comme suit:

Lorsque les valeurs numériques du système physique sont: τ = 0,05 s (constante de temps de rotation), I xx = 0,01 kg·m2, L 2 = 0,5 N·m par unité de contrôle. Les gains PID initiaux ont été choisis sur la base d'un réglage heuristique: K p = 10, K i = 2, K d = 5.

→

Construction de l'array Routh

Nous construisons le tableau pour ce polynôme de quatrième ordre :

Les premières valeurs de colonne sont : 0,05, 1,5, 13.367, 50.84, 10 – toutes positives, aucun changement de signe. Ainsi, le système avec ces gains est stable. Cependant, si nous augmentons le gain intégral à K i = 20, les coefficients polynômes changent et le tableau de Routh révèle un changement de signe, indiquant l'instabilité.

Réglage des paramètres en utilisant les contraintes de Routh-Hurwitz

Au lieu de la simulation d'essai et d'erreur, le critère de Routh-Hurwitz fournit des inégalités algébriques qui doivent être satisfaites pour la stabilité.

En exprimant symboliquement les premières entrées de colonnes en termes de K p, K i et K d, nous avons dérivé trois équations de contrainte. Résoudre ces inégalités définit une région stable dans l'espace de gain. Pour notre quadroter, la région stable a été trouvée être:

Ces contraintes ont guidé la sélection des gains finals : K p = 8, K i = 1, K d = 4, qui se trouvent bien dans la région stable et fournissent également une bonne marge de phase lorsqu'elle est évaluée par réponse de fréquence.

Résultats de simulation et validation

Une simulation non linéaire du quadroteur dans l'environnement Gazebo a été utilisée pour valider les marges de stabilité. Avec les gains optimisés par Routh-Hurwitz, la réponse en rouleau à une entrée en échelon de 10 degrés a montré un temps de décantation de 0,8 seconde, dépassant de moins de 5 % et aucune erreur en état de stabilité.

Les essais de robustesse ont été effectués avec des rafales de vent allant jusqu'à 5 m/s et un bruit de capteur typique des IMU MEMS à faible coût. Le contrôleur a maintenu la stabilité dans tous les cas, l'écart maximum d'angle de roulis restant inférieur à 1,5 degré.

Considérations pratiques de mise en œuvre

Le critère de Routh-Hurwitz est un puissant outil analytique, mais il a des limites. Il s'applique uniquement aux systèmes linéaires invariants du temps, de sorte que le modèle linéarisé doit être valide autour du point d'exploitation. Pour les manœuvres agressives, les effets non linéaires (par exemple, la saturation du vérin, le couple gyroscopique) peuvent causer une dégradation de la stabilité.

De plus, l'implémentation numérique introduit des retards d'échantillonnage et des erreurs de quantification. Ces derniers peuvent être modélisés comme un décalage de phase supplémentaire, ce qui réduit la marge de phase effective. Le critère peut encore être appliqué en incluant le retard de commande numérique comme un poteau supplémentaire dans le polynôme caractéristique.

Conclusion

Le critère de Routh-Hurwitz reste une première étape indispensable dans la conception du système de commande des drones quadroteurs. Cette étude de cas a démontré comment dériver le polynôme caractéristique d'un axe de roulis quadrotor, construire le réseau de Routh, et extraire les contraintes algébriques qui définissent des régions de gain stable. La méthode a permis le rejet rapide des ensembles de paramètres instables sans simulation ou prototypage approfondi.

Pour plus de détails sur le critère de Routh-Hurwitz, voir l'article compréhensif Wikipedia[. Une excellente référence sur la dynamique du quadrotor est l'article de B. Corke dans Robotics and Autonomous Systems.Pour une théorie de contrôle plus approfondie, consulter les Tutoriels de contrôle de l'Université du Michigan pour MATLAB.L'environnement de simulation utilisé peut être trouvé sur le site officiel de Pixhawk=».