La navigation inertielle est généralement intégrée aux équipements GPS et est intégrée par les fournisseurs. Alors de quoi faut-il discuter ici ? Il faut savoir que lorsque le véhicule roule, on peut capter les signaux de lacet et de vitesse du GPS, et du véhicule ? lui-même est également Il existe un ensemble de capteurs pour obtenir le lacet et la vitesse, et comme l'estimation de trajectoire est une partie importante de la conduite autonome, comprendre le principe de fonctionnement de la navigation inertielle peut bien nous aider à effectuer une estimation de trajectoire basée sur le corps.
À l'heure actuelle, le système de navigation combiné composé de GNSS + IMU est la solution de système de positionnement grand public. Le système de navigation inertielle est le seul appareil capable de produire des données complètes à six degrés de liberté. La fréquence de mise à jour des données est élevée et constitue le centre de fusion des informations de positionnement.
Les algorithmes de base utilisés dans la navigation inertielle comprennent principalement 3 types : 1. Algorithme de solution de navigation inertielle ; 2. Couplage par filtre de Kalman de la navigation intégrée. 3. Intégration des informations sur les caractéristiques environnementales et de la navigation inertielle.
Cadre d'algorithme de base du système de navigation intégré
Le système de navigation inertielle (INS) utilise un capteur inertiel (IMU) pour mesurer les informations spécifiques de force et de vitesse angulaire de le transporteur, combiné avec En fonction de certaines conditions initiales, il est intégré aux informations provenant de systèmes tels que le GNSS pour réaliser un système de navigation autonome qui calcule la vitesse, la position, l'attitude et d'autres paramètres en temps réel. Plus précisément, le système de navigation inertielle est un type de navigation à l’estime. C'est-à-dire que la position du point suivant est calculée à partir de la position d'un point connu sur la base de l'angle de cap et de la vitesse du porteur mesurés en continu, de sorte que la position actuelle du corps en mouvement puisse être mesurée en continu.
Schéma du principe de fonctionnement du système inertiel
Le système de navigation inertielle utilise des accéléromètres et des capteurs gyroscopes pour mesurer les paramètres de mouvement du porteur. Trois gyroscopes disposés verticalement sont utilisés pour mesurer la vitesse angulaire du porteur autour de ses trois axes de coordonnées et sont également sensibles à la vitesse angulaire de rotation de la Terre.
L'accéléromètre est basé sur la deuxième loi de Newton et utilise les principes de convection capacitive, piézorésistive ou thermique pour obtenir des valeurs d'accélération en mesurant la force d'inertie correspondante du bloc de masse pendant l'accélération. Utilisé pour mesurer l'accélération de chaque axe sur le système de coordonnées du corps en mouvement.
Schéma du principe de fonctionnement du système inertiel
La navigation inertielle calcule l'angle d'attitude (roulis, angle de tangage) et l'angle d'azimut de la carrosserie du véhicule en intégrant la vitesse angulaire mesurée par le gyroscope et la transformation des coordonnées. Les composantes de l'accélération gravitationnelle sur chaque axe de coordonnées peuvent être calculées en fonction de l'angle d'attitude. L'accélération de chaque axe mesurée par l'accéléromètre est intégrée après soustraction de la composante d'accélération gravitationnelle pour obtenir la vitesse et la position. L'état calculé par navigation inertielle est utilisé pour prédire la position actuelle du véhicule, puis comparé à la position (ou aux données d'observation) obtenue par le récepteur de positionnement par satellite. Les écarts comparés incluent l'erreur d'estimation de la navigation inertielle et l'erreur de positionnement du récepteur satellite. Après pondération via l'algorithme de fusion de données, ils sont utilisés pour corriger la prédiction de navigation inertielle, rendant la prédiction de navigation inertielle de plus en plus précise.
généralement divisé en les étapes suivantes :
Diagramme schématique de l'algorithme de solution de navigation inertielle
En navigation inertielle, chaque itération de l'équation de navigation doit utiliser le dernier résultat de navigation comme valeur initiale, donc l'initialisation de la navigation inertielle est Une des parties les plus importantes. L'alignement d'attitude fait référence à l'obtention du roulis, du tangage et du lacet de l'IMU. Le processus d’alignement du roulis et du tangage est généralement appelé nivellement. Lorsque la voiture est à l'arrêt, la force spécifique mesurée par l'accéléromètre est uniquement causée par la gravité, qui peut être résolue par f=C*g ; pour une IMU de très haute précision, la méthode d'alignement de la boussole peut être utilisée. stationnaire, la force spécifique mesurée par l'accéléromètre est mesurée dans le système porteur. La rotation de la terre est utilisée pour déterminer l'orientation (lacet) du porteur.
Schéma d'initialisation de la navigation inertielle
Utilisez le couplage du filtre Kalman pour fusionner l'IMU et le GNSS, c'est-à-dire les résultats de positionnement du nuage de points. Il peut être divisé en deux méthodes : le couplage lâche et le couplage serré.
Le filtre à couplage lâche utilise la différence entre la position, la valeur de mesure de la vitesse et la vitesse de position calculée comme entrée du filtre de navigation combiné, qui est la mesure de quantité du filtre de Kalman. Les données étroitement couplées incluent les paramètres de navigation GNSS, les pseudo-distances de positionnement, les changements de distance, etc.
Schéma faiblement couplé du filtre Kalman
Schéma étroitement couplé du filtre Kalman
Filtre Kalman Comparaison des avantages et des inconvénients du vrac couplage et couplage serré
Prenant comme exemple le système de navigation inertielle utilisé par Baidu Apollo, il adopte une méthode de couplage lâche et utilise un filtre de Kalman d'erreur. Les résultats de la solution de navigation inertielle sont utilisés pour la mise à jour temporelle du filtre de Kalman, c'est-à-dire la prédiction tandis que les résultats de positionnement GNSS et nuage de points sont utilisés pour la mise à jour des mesures du filtre de Kalman ; Le filtre de Kalman produira les erreurs de position, de vitesse et d'attitude pour corriger le module de navigation inertielle, et les erreurs pendant la période IMU sont utilisées pour compenser les données IMU d'origine.
Couplage lâche du filtre Baidu Apollo Kalman
Diagramme de fusion du filtre Kalman
La solution de navigation inertielle combinée GNSS+IMU actuellement couramment utilisée ne peut toujours pas répondre pleinement aux exigences de la conduite autonome en termes de précision de positionnement et de stabilité dans certains scénarios. Par exemple, dans les scénarios où les signaux GNSS sont faibles pendant une longue période, tels que les groupes de bâtiments urbains et les garages souterrains, s'appuyer sur les signaux GNSS pour mettre à jour un positionnement précis n'est pas suffisamment stable. Par conséquent, de nouvelles sources de données de mise à jour de positionnement précis doivent être introduites. lidar/lidar/ Il est devenu une tendance inévitable d'intégrer le positionnement par détection visuelle et d'autres informations environnementales pour le positionnement.
Un diagramme schématique d'une architecture pour la fusion intégrée d'informations de navigation et de sensibilisation à l'environnement
En prenant comme exemple la solution de système de positionnement par fusion multicapteur de Baidu Apollo, le système de navigation inertielle est au centre de le module de positionnement. Le module intègre IMU, GNSS, Lidar et d'autres informations de positionnement, et produit enfin des informations de position de haute précision avec 6 degrés de liberté qui répondent aux besoins de la conduite autonome après avoir été résolues et corrigées par le système de navigation inertielle.
Cadre du module de positionnement par fusion inertielle de Baidu Apollo
Ce qui précède est le contenu détaillé de. pour plus d'informations, suivez d'autres articles connexes sur le site Web de PHP en chinois!
![[Web front-end] Démarrage rapide de Node.js](https://img.php.cn/upload/course/000/000/067/662b5d34ba7c0227.png)
