GNSS marin
posim_gz_gnss simule un récepteur satellitaire sur le lien d'antenne du modèle. Il convertit sa position dans le monde en coordonnées géographiques, ajoute des erreurs gaussiennes réglables et publie position, vitesse, horodatage et état dans un message unique. Il représente la perte de réception sous l'eau, le blocage explicite, la réacquisition et la latence.
Compiler et monter le récepteur
Dans le terminal A préparé pour votre installation ; sur macOS, utilisez le terminal Linux du bureau RDP :
cd "$POSIM_WS"
source /opt/ros/lyrical/setup.bash
colcon build --merge-install --packages-select posim_gz_gnss posim_robot_models
source install/setup.bash
Le modèle doit avoir un lien physique d'antenne, généralement gnss_link, placé et fixé au véhicule. Le monde doit définir des coordonnées WGS 84. Ajoutez au SDF du modèle :
<plugin filename="libposim_gnss.so" name="posim::Gnss">
<link_name>gnss_link</link_name>
<topic>/model/my_robot/gnss</topic>
<enabled>true</enabled>
<water_level>0</water_level>
<update_rate>5</update_rate>
<latency>0.2</latency>
<reacquire_seconds>3</reacquire_seconds>
<dry_margin>0.05</dry_margin>
</plugin>
Adaptez lien et topic au robot. Le guide Créer un robot explique comment préparer et lancer le modèle.
Les profils donnent des poses par rapport à base_link : WAM-V à z = 1.8 m, BlueROV2 à 0.3 m et REXROV à 0.8 m. WAM-V et les trois profils BlueROV2 activent le récepteur ; REXROV le désactive par défaut. Ces profils sont des données de montage : incorporez lien et plugin au modèle. WAM-V exige aussi le modèle externe Wave Sim.
BlueROV2, BlueROV2 Heavy et la variante sonar incluent le récepteur et l'adaptateur marine_gnss_input. Avec ArduSub, les messages MAVROS GPSINPUT remplacent le GPS synthétique de SITL. L'adaptateur convertit les vitesses ENU en NED et, avec les données GeographicLib installées, la hauteur ellipsoïdale WGS 84 en altitude EGM96 au-dessus du niveau moyen de la mer. Les mesures immergées, bloquées, invalides, futures ou âgées de plus de 1 s signalent une absence de position. Le nombre de satellites est inconnu (255) même pour une position valide ; géométrie des satellites et DOP ne sont pas calculées. Le récepteur de démonstration utilise le niveau moyen z = 0 indépendamment des vagues affichées.
Paramètres
| Paramètre SDF | Unité ou signification | Défaut |
|---|---|---|
update_rate |
Échantillons par seconde simulée ; >0 à 100 Hz | 5 |
latency |
Retard de livraison, secondes simulées ; 0–10 s | 0.2 |
reacquire_seconds |
Temps continu d'acquisition hors de l'eau, s | 3 |
dry_margin |
Dégagement au-dessus de l'eau pour acquérir, m | 0.05 |
horizontal_stddev |
Écart-type de position horizontale, m | 0.7 |
vertical_stddev |
Écart-type de position verticale, m | 1.2 |
velocity_stddev |
Écart-type de vitesse, m/s | 0.1 |
water_level |
z moyen de l'eau sans topic de vagues, m | 0 |
seed |
Graine aléatoire du récepteur | 42 |
enabled |
Récepteur actif | true |
link_name |
Lien d'antenne dans le modèle | gnss_link |
topic |
Topic Gazebo de mesure | /model/<model-name>/gnss |
wave_topic |
Topic facultatif de hauteur d'eau | Vide |
Les réglages numériques doivent être finis. Latence, temps d'acquisition, marge et écarts-types doivent être positifs ou nuls.
Hauteur locale de l'eau
Sans wave_topic, le récepteur utilise le plan moyen de l'eau. Avec un topic configuré, il lui faut des hauteurs locales récentes ; des données absentes ou invalides produisent surface unavailable.
Le message gz.msgs.Double_V contient, dans l'ordre : schéma 1, taille de grille, dimensions périodiques X/Y, vitesse et angle du vent, cambrure des vagues, temps simulé et hauteurs rangées par lignes.
- Taille de grille : entier de 2 à 256, suivi d'un nombre de valeurs de hauteur égal au carré de cet entier.
- Dimensions X/Y : finies et strictement positives.
- Horodatage : fini, âgé d'au plus 0.6 seconde simulée, jamais futur.
Configurez séparément un publieur compatible. Les métadonnées du vent ne pilotent pas la réception.
Lire les mesures et le blocage
Après avoir lancé le modèle configuré, lisez son topic dans le terminal B préparé :
gz topic -e -t /model/my_robot/gnss
Chaque message contient 15 nombres en double précision. Les indices commencent à zéro. Conservez l'horodatage d'acquisition même si la solution arrive avec retard.
| Indice | Champ et unité |
|---|---|
| 0–3 | Schéma 1, époque de réinitialisation, acquisition en secondes simulées, état |
| 4–6 | Latitude en degrés, longitude en degrés, altitude en m |
| 7–9 | Vitesses est, nord et haut, m/s |
| 10–12 | Variances de position horizontale/verticale en m² et de vitesse en (m/s)² |
| 13–14 | z de l'antenne dans le monde et hauteur locale de l'eau, m |
États : 0 disabled (désactivé), 1 submerged (immergé), 2 acquiring (acquisition), 3 fix (solution valide), 4 blocked (bloqué) et 5 surface unavailable (surface indisponible).
Une mesure invalide contient des coordonnées et vitesses NaN. Le contact avec l'eau ou le blocage supprime les solutions en attente. Pour la réacquisition, l'antenne doit rester au-dessus de la marge sans interruption. Une réinitialisation efface temporisation et mesures retardées, puis incrémente l'époque.
Pour bloquer l'antenne ; utilisez false pour la libérer :
gz topic -t /model/my_robot/gnss/blocked -m gz.msgs.Boolean -p 'data: true'
Interpréter et vérifier
Comparez une antenne fixe hors de l'eau, immergée, bloquée, puis rétablie. Vérifiez acquisition, retard, époque après réinitialisation et horodatages croissants. Le programme qui reçoit les données doit rejeter les solutions périmées ou futures et gérer les états invalides.
L'adaptateur BlueROV2 fourni alimente ArduSub ; les autres consommateurs ROS NavSatFix et autopilotes personnalisés nécessitent encore un adaptateur.
Ce modèle repose sur la pose de l'antenne. Il ne calcule ni géométrie satellitaire, ni propagation RF, ni trajets multiples physiques, ni positionnement acoustique. La précision configurée est une donnée de simulation, pas une garantie fabricant. Consultez l'implémentation et le guide du paquet.