Résumé Technique : C-ZUPT : Vol Stationnaire Aérien Assisté par la Stationnarité

Énoncé du Problème

Les systèmes autonomes opérant dans des environnements privés de Système Global de Navigation par Satellite (GNSS) font face à un défi critique : maintenir une estimation d'état précise sur de longues durées. Bien que les systèmes de navigation inertielle (INS) reposent sur des mesures à haute fréquence, ils sont intrinsèquement sujets à la dérive causée par les biais et le bruit des capteurs. En l'absence de corrections externes (telles que le GNSS ou des mises à jour visuelles), les erreurs d'estimation s'accumulent sans contrôle, entraînant une divergence du filtre et une perte de contrôle.

Les solutions traditionnelles, telles que les mises à jour de vitesse nulle (ZUPT), sont hautement efficaces pour les plateformes liées au sol (par exemple, les piétons, les véhicules) en exploitant les périodes de repos physique. Cependant, ces méthodes sont généralement inapplicables aux plateformes aériennes comme les quadricoptères, qui atteignent rarement une vitesse strictement nulle même en vol stationnaire, en raison de la nécessité d'un contrôle actif continu pour contrer les perturbations. Par conséquent, les systèmes aériens manquent d'un mécanisme fiable, sans capteur, pour ancrer leur estimation d'état pendant les phases de vol stationnaire, ce qui entraîne une dégradation rapide de la précision et une augmentation de la consommation d'énergie alors que les contrôleurs luttent contre les erreurs accumulées.

Méthodologie

Les auteurs proposent la Mise à jour de Vitesse Nulle Contrôlée (C-ZUPT), une approche de correction d'état sans capteur conçue spécifiquement pour la navigation aérienne. La méthodologie intègre trois composants principaux :

1. Cadre Théorique et Modélisation

Le système modélise le quadricoptère comme un système dynamique en temps continu linéarisé autour d'un point d'équilibre de vol stationnaire.

• Dynamique : Un cadre Newton-Euler décrit le mouvement à 6 degrés de liberté (DoF), tenant compte de la poussée, de la gravité et de la traînée aérodynamique (négligée à basse vitesse).
• Architecture de Contrôle : Le système emploie un contrôleur Linéaire-Quadratique-Gaussien (LQG), combinant un Régulateur Linéaire-Quadratique (LQR) pour le contrôle et un Filtre de Kalman (KF) pour l'estimation d'état.
• Modélisation de la Batterie : Pour évaluer l'efficacité énergétique, un modèle de circuit équivalent basé sur Thevenin simule la dynamique de la batterie, incluant l'affaissement de tension, l'évolution de l'état de charge (SoC) et les réponses transitoires aux demandes de courant élevé.

2. Le Mécanisme C-ZUPT

L'innovation centrale est une heuristique qui identifie les « équilibres quasi-statiques » pendant le vol pour déclencher des corrections ZUPT sans nécessiter de contact physique avec une surface.

• Logique de Détection : L'algorithme surveille les normes $L_2$ des vitesses corporelles estimées ($\hat{v}_B$) et des forces spécifiques ($\tilde{f}$) sur une fenêtre glissante ($K$ échantillons).
• Condition de Déclenchement : Lorsque les deux normes tombent en dessous de seuils prédéfinis ($\delta_{\hat{v}}$ et $\delta_{\tilde{f}}$), le système suppose un état quasi-stationnaire.
• Correction : Une fois la détection effectuée, le filtre applique une mise à jour de pseudo-mesure ($y_k = 0$) aux états de vitesse, réinitialisant efficacement l'erreur de vitesse et limitant la croissance de l'incertitude. Cela est mis en œuvre comme un mécanisme d'« aide informationnelle », agissant comme une mesure synthétique dérivée de la physique de l'équilibre de vol stationnaire.

3. Flux de Signal et Implémentation

L'approche prend en compte les non-idéalités réelles dans la boucle de contrôle :

• Traitement des Commandes : Les sorties LQR sont converties en vitesses de rotors via un solveur de moindres carrés non négatifs (NNLS) pour assurer la faisabilité physique, suivies par la génération de PWM.
• Dynamique des Actionneurs : L'inertie des rotors et les retards aérodynamiques sont modélisés comme des systèmes du premier ordre, créant un délai entre la commande et la poussée réelle.
• Intégration : La mise à jour C-ZUPT contourne l'étape de prédiction standard du KF lorsque la stationnarité est détectée, injectant directement la contrainte de vitesse nulle dans la boucle d'estimation.

Contributions Clés

1. ZUPT Aérienne Sans Capteur : L'article présente la première implémentation ZUPT pour les plateformes aériennes qui ne repose pas sur un contact avec le sol, exploitant le contrôle actif pour maintenir un équilibre quasi-statique.
2. Navigation Résistante à la Dérive : Une méthode spécifique de correction de vitesse adaptée aux quadricoptères qui supprime la dérive pendant les phases stationnaires, validée par un cadre publiquement disponible.
3. Estimation Consciente de la Batterie : Un modèle de circuit intégré permettant une surveillance énergétique en temps réel, permettant aux auteurs de quantifier la relation entre la précision de l'estimation et la consommation d'énergie.
4. Modélisation de Mouvement Haute Fidélité : Un modèle système complet couplant le contrôle LQG avec la dynamique de la batterie et les retards des actionneurs pour simuler des conditions de vol réalistes dans des limites de capteurs.

Résultats et Analyse

Des simulations extensives ont été menées pour évaluer le système sous divers taux de mise à jour ($\Gamma$) et niveaux de perturbation, comparant le système assisté par C-ZUPT à une référence sans aide.

• Stabilité et Réduction de l'Erreur : Dans des scénarios avec des mises à jour GNSS espacées (par exemple, $\Gamma = 0,005$), le système non assisté a montré une divergence significative des erreurs d'estimation et de contrôle. Le système C-ZUPT a maintenu la stabilité, réduisant :
  • L'erreur de suivi de 28,8 %
  • L'erreur d'attitude de 21,6 %
  • Le temps de saturation du contrôle de 76,9 %
  • L'incertitude d'estimation de 28 %
• Effort de Contrôle : En corrigeant la dérive de vitesse, C-ZUPT a réduit l'effort de contrôle nécessaire pour maintenir le vol stationnaire d'environ 31,9 %.
• Efficacité Énergétique : La réduction de l'effort de contrôle s'est traduite directement par des économies de puissance. Le système C-ZUPT a démontré une réduction de 3 % à 7 % de la consommation moyenne d'énergie et du courant tiré par rapport à la référence.
• Extension du Temps de Vol : Grâce à une efficacité améliorée, le temps de vol stationnaire sûr estimé (avant d'atteindre 30 % de SoC de batterie) a augmenté d'environ 1 minute sur tous les niveaux de perturbation testés, représentant une amélioration de 3 % à 6 % de l'efficacité globale du système.

Importance et Revendications

Les auteurs affirment que C-ZUPT fournit une solution pratique pour prolonger l'endurance opérationnelle des systèmes aériens contraints en ressources dans des environnements privés de GNSS. En exploitant la stabilité inhérente du vol stationnaire contrôlé, la méthode atténue la divergence du filtre et améliore la stabilité de la navigation sans nécessiter de capteurs supplémentaires.

L'article postule que ces améliorations sont cruciales pour des missions sensibles au temps où l'efficacité énergétique et le vol soutenu sont primordiaux, citant spécifiquement des applications dans :

• La guerre urbaine et la police
• Les opérations de sauvetage
• La surveillance persistante
• L'inspection des infrastructures
• Les services de livraison

Les auteurs reconnaissent des limites, notant que la méthode repose sur une dynamique modérée (les erreurs de vitesse doivent rester bornées) et nécessite un réglage minutieux des paramètres heuristiques (seuils et tailles de fenêtre) pour équilibrer la sensibilité et les faux positifs. Néanmoins, l'étude conclut que C-ZUPT transforme efficacement les intervalles de stationnarité aérienne en un atout clé pour une navigation robuste et sans capteur.