WWW-POSIM v0.6.16Documentation du simulateur
Menu de la documentation
WWW-POSIM / Documentation du simulateur

GNSS et navigation

Les sessions WAM-V et BlueROV2 activent par défaut le récepteur GNSS satellite simulé de POSIM. BlueROV2 permet sa désactivation explicite. Contrat de capteur, antenne et topics sont communs. L’état GNSS reste distinct de l’estimation de position FCU.

Implémentation

Étape Méthode Paramètres et sortie
Cinématique d’antenne Le plugin Gazebo natif posim::Gnss observe le lien réel, rotation et bras de levier compris. link_name, pose ; position géographique et vitesse par différences finies.
Erreurs Perturbations gaussiennes indépendantes de position et vitesse, avec graine. horizontal_stddev, vertical_stddev, velocity_stddev, seed ; covariance diagonale.
Disponibilité Test sec/immergé sur les vagues, hystérésis, réacquisition continue et obstruction explicite. water_level, wave_topic, dry_margin, reacquire_seconds, enabled ; position valide, acquisition, immersion, obstruction ou indisponibilité.
Temps Cadence et file de mesures retardées en temps simulé. update_rate, latency ; conserve l’horodatage d’acquisition.
ROS et FCU Vérifie époque, temps et valeurs finies ; publie mesure/état et convertit les mesures acceptées en MAVLink GPS_INPUT. Alias du capteur, GPS brut FCU et estimation fusionnée restent distincts.
Interface et mission Fraîcheur et état EKF déterminent disponibilité et gardes de mission. L’indicateur de fusion interprète les états ; il n’expose pas toutes les innovations du filtre.

L’implémentation et les profils du récepteur définissent le capteur. WWW-POSIM ajoute conversion ROS, sélection de source et intégration aux missions. Voir Modèles et paramètres des capteurs.

Mesures et estimations

Sortie Signification
/model/{robot}/gnss/fix NavSatFix du capteur : position de l’antenne avec le bruit configuré.
/model/{robot}/gnss/status État et temps d’acquisition original ; JSON dans std_msgs/String.
/vehicle/gnss/fix, /vehicle/gnss/status Alias du véhicule actif pour les mêmes messages, pas un second injecteur GPS.
/mavros/global_position/raw/fix GPS reçu par ArduPilot puis converti par MAVROS.
/mavros/global_position/global Position fusionnée de la FCU.
/mavros/local_position/pose Pose locale fusionnée, ENU.
/model/{robot}/odometry Référence du simulateur pour vue 3D, sécurité du terrain et validation ; pas la source des coordonnées de la carte

Gazebo génère les mesures. L’adaptateur convertit les mesures acceptées en GPS_INPUT, récepteur 0. Le profil ArduPilot choisit ce récepteur MAV, désactive le second et le GPS synthétique SITL, puis utilise position/vitesse horizontale GPS et cap compas. Aucune pose ou vitesse de référence du simulateur n’est injectée comme vision dans la FCU, même lorsque GNSS est désactivé. Une antenne seule ne mesure pas le cap à l’arrêt ; la route GPS en mouvement diffère également du cap du corps.

Le profil GNSS définit le plancher de bruit de vitesse horizontale EK3_VELNE_M_NSE à partir de receiver.velocity_stddev, borné à la plage documentée de 0.05–5 m/s (par défaut 0.1 m/s). La précision de vitesse déclarée par le récepteur peut relever le plancher effectif. Cela règle la pondération EKF ; le bruit de mesure simulé reste inchangé.

L’IMU Gazebo du WAM-V transmet accélération et vitesse angulaire par l’interface JSON ArduPilot. Le compas utilise le champ magnétique SITL. Cette dépendance de simulation est idéalisée ; elle ne déduit pas le cap stationnaire de l’antenne GNSS.

Les cibles utilisent l’origine géographique EKF de la FCU ; les arrivées sont décidées avec la position estimée. La vérité simulateur sert à évaluer les trajectoires et vérifier le terrain, sans recaler l’erreur horizontale du récepteur. Une mesure GNSS récente ne garantit pas un filtre sain : validité EKF et fusion sont indiquées séparément. L’indicateur combine source configurée, état récent et drapeaux EKF ; ce n’est pas un journal d’innovations par observation.

Pour les missions avec GNSS configuré, après armement, la mission exige 2 secondes réelles continues de pose locale récente et de fusion observée du GNSS ou de navigation externe acceptée avant GUIDED. Une perte recommence l’intervalle; sans stabilisation sous 35 secondes, la mission s’arrête. La réacquisition utilise un autre compteur en temps simulé.

Les espaces web et installés demandent états EKF/système et signal de présence FCU à 5 Hz simulés. Les états âgés de plus de 3 s réelles sont rejetés. Avec une position validée par l’horloge, l’adaptateur répète sa validité toutes les 0,2 s réelles, en gardant le temps d’acquisition initial. Chaque entrée GPS et mesure publiée provient d’une nouvelle acquisition acceptée. Une horloge arrêtée ou une mesure périmée invalide le récepteur.

Configuration et repères

posim_gz_gnss/config/profiles.json définit réglages et montage. Le SDF contient base_link → gnss_link → gnss, et le publicateur de poses expose la hiérarchie réelle par TF. L’antenne WAM-V se trouve 1,8 m au-dessus de base_link ; celle de BlueROV2, 0,3 m. Le lien ajoute 0,001 kg.

La vérité utilise map et les liens du modèle. L’estimation utilise fcu_map et TF map → fcu_map → fcu_base_link. La première transformation projette l’origine géographique EKF dans le datum du terrain, sans ajustement contre la vérité. Sa translation verticale est supposée nulle : approximation du zéro barométrique local, pas altitude de levé. Le TF du capteur appartient à la hiérarchie de vérité ; un traitement de levé doit appliquer les mêmes extrinsèques à la pose estimée et conserver les temps.

Grandeur Valeur par défaut
Coordonnées Latitude/longitude WGS 84 en degrés ; datum défini par les coordonnées sphériques du monde.
Repère local ENU : est, nord, haut ; orientation du monde 0°.
Repère du corps FLU ; décalage d’antenne converti en FRD : x, −y, −z.
Vitesse Déplacement d’antenne entre acquisitions, tourné en ENU ; GPS_INPUT utilise nord, est, bas.
Bras de levier Appliqué géométriquement avant mesure et fourni à ArduPilot comme le même décalage corporel.
Écart-type de position Est et nord : 0,7 m chacun ; vertical : 1,2 m.
Écart-type de vitesse 0,1 m/s par axe.
Covariance Diagonale ENU connue : 0,49 ; 0,49 ; 1,44 m².
Fréquence / latence 5 Hz / 0,2 s simulées.
Validité Rejette doublons, ordre inversé, valeurs non finies, futur et âge supérieur à 0,6 s ; surveillance de progression d’horloge de 0,8 s réelles.
Temps Horodatage d’acquisition conservé malgré le retard ; semaine GPS déterministe 2296 plus temps simulé.
Qualité nominale 12 satellites, HDOP 1,0, VDOP 1,5 ; pas de calcul de constellation.
Aléatoire Graine 42 ; erreurs gaussiennes indépendantes de position et vitesse.

Le monde par défaut utilise une altitude marine de 0 m et une séparation géoïdale synthétique nulle. Sous cette hypothèse, altitude du capteur et altitude MSL GPS_INPUT coïncident. MAVROS applique sa conversion EGM96 pour l’altitude ellipsoïdale, qui peut donc différer du topic capteur. La géodésie verticale absolue n’est pas qualifiée pour les levés. La profondeur reste référencée à l’eau locale. Une chaîne GNSS+IMU+profondeur multifaisceau doit préserver repères, temps et datum vertical.

Immersion, perte et récupération

Le récepteur compare la hauteur mondiale de l’antenne, rotation comprise, à la surface locale. Les mondes applicatifs utilisent le champ local du solveur de vagues physique, interpolé bilinéairement. Un échantillon de surface âgé de plus de 0,6 s simulée rend le capteur indisponible. Les modèles POSIM seuls utilisent le plan moyen configuré sauf si un topic de vagues est fourni.

L’application relaie les cellules mesurées avec leur horodatage original, âgées de 0,2–0,5 seconde de simulation. Les cellules absentes restent invalides ; le récepteur exige des valeurs locales finies et vérifie l’immersion de l’antenne.

À la surface ou dessous, la position est immédiatement invalidée et la file retardée vidée. L’acquisition démarre au-dessus d’une marge sèche de 0,05 m et exige 3 s simulées continues. Un récepteur déjà verrouillé reste valide dans cette marge jusqu’à la limite mouillée. Cette hystérésis évite les bascules rapides avec les vagues.

Sans position, les coordonnées sont NaN. L’adaptateur envoie un GPS_INPUT explicitement invalide, sans renouveler artificiellement l’horodatage d’une ancienne coordonnée. Une réinitialisation vide la file, remet l’acquisition à zéro, avance l’époque et reprend la validation de l’horloge.

La perte du fix sous l’eau permet de conserver les commandes manuelles d’attitude, profondeur et poussée pour remonter. Les missions absolues nécessitent une estimation FCU récente et valide issue des capteurs. WAM-V exige un fix récent ou une source externe qualifiée et acceptée, ainsi que les autres contrôles d’armement.

Le booléen Gazebo /model/{robot}/gnss/blocked impose une obstruction. Le vent ne désactive pas directement GNSS : il peut déplacer ou incliner le véhicule et créer des vagues qui immergent l’antenne. Géométrie satellitaire, bâtiments, trajets multiples, atmosphère, interférences RF et diagrammes d’antenne ne sont pas simulés physiquement. Bruit gaussien, obstruction et immersion sont des modèles simplifiés, pas des performances RF mesurées.

Équipement BlueROV2

Le récepteur sélectionnable est une charge simulée. Il n’affirme pas que le BlueROV2 de série embarque un GNSS satellite ni que le constructeur propose ce kit.

L’intégration Water Linked associe référence géographique en surface et positionnement acoustique sous-marin. Le constructeur décrit aussi DVL avec UGPS. Ce sont des équipements et mesures séparés : ce récepteur satellite n’implémente pas UGPS acoustique.

GPS.gov explique les facteurs d’exactitude réelle. Les écarts-types simulés sont des réglages, pas une garantie du service GPS. Les liens sont des références ; le récepteur n’embarque ni images produit, ni manuels, ni code fournisseur.

Position cartographique issue des capteurs

Ground Control utilise une mesure GNSS récente ou une estimation externe valide acceptée par la passerelle FCU, sans remplacement par les coordonnées du simulateur. GPS fixed est vert, GPS lost rouge; inconnu, périmé et invalide restent distincts. Fix et disponibilité de navigation sont indépendants.

Avec GPS fixed, seul l’indicateur GPS apparaît. Avec GPS lost et une estimation récente et validée, Estimation de position ON apparaît aussi. Si une estimation sous-marine est nécessaire mais indisponible, Estimation indisponible apparaît. Le bouton d’information à côté de ON ouvre la méthode et un lien documentaire par clic, toucher ou clavier ; Échap ferme l’aide. Les coordonnées numériques sont masquées. Ouvrez Détails de navigation sous la carte pour consulter le support, le repère initial et l’initialisation des capteurs.

L’estimateur IMU/DVL utilise vitesse angulaire, force spécifique et vitesse valide relative au fond, en conservant temps, montages et covariance. Il ne consomme pas l’orientation Gazebo. L’odométrie locale seule ne définit ni position géographique ni cap.

La BlueROV2 · KMOU utilise une coordonnée initiale déclarée par le scénario et le cap mesuré au magnétomètre avec déclinaison configurée. Cette référence est distinguée du GPS. Un support temporaire maintient le véhicule pendant la préparation des caméras et l’initialisation stationnaire. Après armement normal en ALT_HOLD et acceptation de la navigation, le support est libéré et la suppression réelle de la liaison confirmée. La référence n’est pas continuellement recalée sur la vérité du simulateur.

Ce profil se limite à cette démo intégrée, sans activation automatique pour véhicules enregistrés ou mondes arbitraires. L’alignement général par mouvement GNSS n’est pas qualifié pour la sortie géographique. Le diagnostic local garde navigation_ready=false; la passerelle détermine séparément la disponibilité avec données récentes, origine/covariance valides, sélection de source acquittée et télémétrie EKF/globale FCU.

Perte DVL, données périmées, réinitialisation ou nouveau segment invalident l’estimation. La carte retire les coordonnées estimées et affiche l’échec. Le retour du DVL ne réutilise pas l’ancrage initial: redémarrez la simulation. Un nouveau fix en surface peut rétablir la position GNSS sans réinitialiser l’estimateur sous-marin.

ArduPilot, QGC et fournisseurs remplaçables

GNSS alimente GPS_INPUT et la source EKF 1. Les position/vitesse externes acceptées utilisent MAVROS vision pose/speed et la source 2. WAM-V en GNSS par défaut n’active pas une entrée d’odométrie visuelle inutilisée. Un fournisseur externe explicitement sélectionné active la même voie contrôlée sur les deux véhicules.

QGC reçoit la validité GPS par GPS_RAW_INT et la position fusionnée par GLOBAL_POSITION_INT. L’indicateur peut être sans fix avec une estimation FCU valide. L’estimation ne modifie pas le fix. La Commander avec QGC impose de désarmer avant transfert du contrôle; la flottabilité peut faire remonter le véhicule sous-marin.

Les extensions de l’application installée sélectionnent un fournisseur ROS approuvé, lié à ses empreintes et déclaré en SDF. /vehicle/navigation/estimate transporte pose ENU et vitesse corps FLU dans nav_msgs/Odometry; /vehicle/navigation/status fournit session, temps, origine, métadonnées de disponibilité et source correspondants. La passerelle rejette données périmées, discordances et éditeurs multiples. Le récepteur reste responsable du GNSS. Voir Commander un espace de travail local. Charger un fournisseur ne qualifie ni précision géographique ni disponibilité de mission.

Rechercher dans la documentation