Sonar multifaisceaux
Le sonar multifaisceaux de POSIM utilise un modèle de diffuseurs ponctuels pour produire des données d'intensité en fonction de la distance et des images acoustiques. Le même plugin propose le calcul sur CPU, WGPU ou CUDA. WGPU s'appuie sur Vulkan sous Linux ou Metal dans un environnement macOS natif pour utiliser des GPU de différents fabricants. Consultez la configuration du calcul.
Lancer un exemple
Préparez les terminaux A et B et compilez les paquets sonar s'ils ne sont pas installés. Lancez la simulation dans A et consultez les données dans B. La première commande choisit automatiquement le moteur de calcul ; l'exemple dédié choisit WGPU et ouvre aussi RViz.
ros2 launch posim_demos posim_sensor.launch.py \
namespace:=blueview_p900 world_name:=posim_multibeam_sonar \
paused:=false x:=4 z:=2.0 yaw:=3.14 gui:=true headless:=false
Le paquet posim_multibeam_sonar_demo propose aussi un exemple autonome :
ros2 launch posim_multibeam_sonar_demo multibeam_sonar_demo.launch.py \
compute_backend:=wgpu

Lancez un seul exemple à la fois. Remplacez wgpu par cpu, cuda ou auto pour changer de moteur de calcul. Pour un sonar embarqué, sélectionnez bluerov2_heavy_multibeam_sonar avec un monde adapté.
Fonctionnement du capteur
Gazebo fournit la géométrie de la scène. Le modèle estime les normales de surface, calcule la rétrodiffusion acoustique, applique la réponse de réception et comprime les échos dans les cellules de distance. Les données acoustiques et l'image représentent la même observation. Utilisez les données brutes pour l'analyse et conservez les réglages de gain et d'affichage.
Une valeur positive de spec/receiveBeamWidth active le mode physique, qui utilise les coordonnées XYZ mesurées par une caméra de profondeur couvrant tout le champ du sonar. Les échantillons géométriques, les directions de réception et les sorties en distance sont indépendants. Les cellules dont le centre se trouve dans le champ se répartissent son angle solide complet ; leurs surfaces projetées et la réponse de réception signée déterminent les contributions aux faisceaux. Le modèle utilise une impulsion de Hamming en bande de base, de bande passante fixe et de crête unitaire. L'intervalle de calcul interne dépasse l'intervalle de distance publié. Le pas de sortie vaut soundSpeed / (2 × bandwidth) ; la longueur de calcul ne détermine pas le gain de l'impulsion. L'intervalle de garde interne n'est pas publié et ne modifie pas ce pas.
ray/scan/horizontal/samples définit les colonnes géométriques, ray/scan/vertical/rays les lignes de l'image et beams les directions de réception. Le mode physique exige un champ symétrique inférieur à 180° sur chaque axe. Les limites de distance sont radiales ; les pixels hors champ ou hors limites ont des XYZ invalides dans le nuage organisé. spec/receiveBeamWidth indique la largeur totale à mi-puissance en radians ; spec/receiveGain règle le gain linéaire de pression (1 par défaut). Une largeur absente ou nulle sélectionne le mode de grille par défaut. Le mode physique prend en charge CPU et WGPU, mais pas CUDA. Il n'y a pas de plafond fixe de 4096 échantillons de fréquence ; les grandes grilles restent limitées par les ressources du moteur et les dimensions représentables. Les coefficients de diffusion sont générés par image et cellule géométrique. Le modèle décrit des échos en bande de base, sans propagation de phase porteuse ni étalonnage de l'amplitude du matériel.
Examiner les sorties
Dans le terminal B :
ros2 topic list -t
ros2 topic echo /sensor/multibeam_sonar/sonar_image \
sensor_msgs/msg/Image --once --no-arr --qos-reliability reliable
- Les images utilisent une QoS
reliable. Choisissez aussi cette fiabilité dans l'affichage Image de RViz. - Ajoutez PointCloud2 pour
/sensor/multibeam_sonar/point_cloud. - Les échos bruts utilisent
marine_acoustic_msgs/msg/ProjectedSonarImage. - Le lancement BlueView transmet l'horloge de Gazebo à ROS
/clock. Pour les nœuds avecuse_sim_time, vérifiez que la simulation tourne et que l'horloge avance.
Configuration du capteur
Placez ces systèmes directement dans <world> :
<plugin filename="gz-sim-sensors-system" name="gz::sim::systems::Sensors">
<render_engine>ogre2</render_engine>
</plugin>
<plugin filename="libmultibeam_sonar_system" name="custom::MultibeamSonarSystem"/>
Placez le capteur P900 dans un <link> du modèle :
<sensor name="multibeam_sonar" type="custom" gz:type="multibeam_sonar">
<always_on>true</always_on>
<update_rate>30.0</update_rate>
<topic>/sensor/multibeam_sonar</topic>
<visualize>true</visualize>
<gz:multibeam_sonar>
<ray degrees="false">
<scan>
<horizontal>
<beams>512</beams>
<min_angle>-1.13447</min_angle>
<max_angle>1.13447</max_angle>
</horizontal>
<vertical>
<rays>300</rays>
<min_angle>-0.10472</min_angle>
<max_angle>0.10472</max_angle>
</vertical>
</scan>
<range>
<min>0.1</min>
<max>10.0</max>
</range>
</ray>
<spec>
<!-- Sonar properties -->
<verticalFOV>12</verticalFOV>
<sonarFreq>900e3</sonarFreq>
<bandwidth>29.9e3</bandwidth>
<soundSpeed>1500</soundSpeed>
<sourceLevel>220</sourceLevel>
<maxDistance>10</maxDistance>
<raySkips>10</raySkips>
<sensorGain>0.02</sensorGain>
<blazingSonarImage>true</blazingSonarImage>
<writeLog>false</writeLog>
<debugFlag>false</debugFlag>
<writeFrameInterval>5</writeFrameInterval>
<!-- ROS publication topics -->
<pointCloudTopicName>point_cloud</pointCloudTopicName>
<sonarImageRawTopicName>sonar_image_raw</sonarImageRawTopicName>
<sonarImageTopicName>sonar_image</sonarImageTopicName>
<frameName>forward_sonar_optical_link</frameName>
</spec>
</gz:multibeam_sonar>
</sensor>
L'exemple demande 512 faisceaux horizontaux sur environ 130°, 300 rayons verticaux sur environ 12° et une portée de 0.1 à 10 m. Il utilise une fréquence de 900 kHz, une bande passante de 29.9 kHz et une célérité du son de 1500 m/s. Les 30 Hz indiqués sont une consigne ; la cadence reçue dépend du calcul et du rendu. Consultez le modèle complet.
Paramètres de <spec>
| Paramètre | Rôle | Valeur par défaut | Exemple P900 |
|---|---|---|---|
verticalFOV |
Ouverture acoustique verticale, degrés | 10 | 12 |
sonarFreq |
Fréquence acoustique, Hz | 900000 | 900000 |
bandwidth |
Bande passante, Hz | 29500000 | 29900 |
soundSpeed |
Célérité du son, m/s | 1500 | 1500 |
sourceLevel |
Niveau de la source, dB | 220 | 220 |
maxDistance |
Portée du traitement, m ; à accorder à celle des rayons | 60 | 10 |
raySkips |
Pas d'échantillonnage vertical ; entier positif | 10 | 10 |
sensorGain |
Gain d’amplitude des échos dans la grille CPU par défaut ; inutilisé en mode physique et par WGPU/CUDA | 0.02 | 0.02 |
blazingSonarImage |
Graine aléatoire issue de l'horloge réelle ; false fixe la graine à 1234 |
false | true |
pointCloudTopicName |
Suffixe du topic Gazebo du nuage de points | point_cloud |
Identique |
sonarImageRawTopicName |
Suffixe du topic ROS des échos bruts | sonar_image_raw |
Identique |
sonarImageTopicName |
Suffixe du topic ROS de l'image | sonar_image |
Identique |
frameName |
Identifiant du repère optique | forward_sonar_optical_link |
Identique |
writeLog |
Écrire les CSV dans un répertoire propre à l'exécution | false | false |
writeFrameInterval |
Nombre d'images entre deux écritures ; entier positif | 10 | 5 |
debugFlag |
Messages de diagnostic dans la console | false | false |
plotScaler |
Lu et affiché, mais sans effet sur la génération de l'image | 10 | Non renseigné |
Topics et repères
Les suffixes s'ajoutent au <topic> du capteur, ici /sensor/multibeam_sonar. Le nuage de points Gazebo est de type gz.msgs.PointCloudPacked ; le pont ROS fourni le transmet en sensor_msgs/msg/PointCloud2. Faites correspondre pointCloudTopicName à sensor_config.py et renseignez le repère optique dans frameName.
Les fichiers de lancement du BlueView P900 et du sonar BlueROV2 publient une transformation identité de world vers le repère du sonar pour l'affichage dans RViz. Les coordonnées du nuage de points restent relatives au capteur. Cette transformation statique ne suit pas le véhicule et ne tient pas compte de la position ni de l'orientation du montage du sonar. Pour cartographier dans le repère monde, remplacez-la par une chaîne de transformations qui prend en compte la pose du véhicule et celle du montage du sonar.
Géométrie des rayons
Par défaut, <ray> définit 256 faisceaux horizontaux, 3 rayons verticaux, des angles horizontaux de ±π/4, verticaux de ±π/8 et une portée de 0.1 à 5 m. Les angles sont en radians, sauf avec degrees="true". Le <reference_frame> facultatif dans <gz:multibeam_sonar> utilise une pose nulle par défaut.
Conservez les blocs <ray> et <spec> complets : les valeurs par défaut concernent leurs champs internes. Accordez la portée des rayons et maxDistance. L'implémentation précise la lecture des paramètres et les publications.
Comparer des essais
Désactivez l'enregistrement pour mesurer le débit, sauf s'il fait partie de l'expérience. Consultez le guide Configurer et régler le sonar. Conservez les paramètres acoustiques et la valeur de blazingSonarImage pour comparer les essais.
Moteur de calcul
| Choix | Comportement |
|---|---|
auto |
Essaie CUDA, puis WGPU, puis CPU ; choix par défaut |
wgpu |
Utilise un adaptateur Vulkan/Metal compatible ; son absence empêche l'initialisation du capteur |
cuda |
Requiert un GPU NVIDIA et le backend CUDA compilé et installé ; échoue s'ils sont indisponibles |
cpu |
Calcule les échos sur le CPU ; le rendu Gazebo reste nécessaire |
Le lancement dédié accepte compute_backend. Les autres lancements lisent POSIM_SONAR_COMPUTE_BACKEND. Vérifiez la ligne Using sonar compute backend: au démarrage. Le guide Configurer et régler le sonar détaille le choix de l'adaptateur, les prérequis et les différences numériques.
Ajouter un capteur
- Copiez
models/posim_sensor_models/description/blueview_p900/sous un nouvel identifiant. - Préparez le
config/<identifiant>/sensor_config.pycorrespondant. Accordez les noms de modèle, de liens, de repères et les topics du pont. - Réglez les échantillons, les angles et la portée. Chargez dans le monde les deux systèmes présentés plus haut ; consultez le SDF du monde sonar.
- Préparez le moteur de calcul et le rendu, recompilez l'espace de travail et chargez son environnement. Sélectionnez le capteur avec les arguments de lancement.
Enregistrer et tracer les données brutes
Avec writeLog=true, chaque capteur crée SonarRawData_<run>_<suffix>/ dans le répertoire de travail du simulateur et en affiche le chemin. Il y place des CSV numérotés et SonarRawData_beam_angles.csv, sans écraser les essais précédents. Un intervalle inférieur à 1 est ramené à 1. Si le répertoire ne peut pas être créé, l'enregistrement est désactivé et une erreur est affichée.
Dans le répertoire indiqué, ouvrez la première image :
ros2 run posim_multibeam_sonar_demo plotdata.py SonarRawData_000001.csv
Pour enregistrer les figures en PNG :
ros2 run posim_multibeam_sonar_demo plotdata.py SonarRawData_000001.csv \
--output-dir plots --no-show
L'outil de tracé s'installe aussi sans CUDA. Il produit une vue sonar et cinq profils de faisceaux régulièrement espacés, ou tous les profils s'il y en a moins de cinq.
| Option | Effet |
|---|---|
--range-max |
Distance maximale affichée, m |
--beam-step |
Afficher un faisceau sur N |
--dynamic-range |
Plage sous le maximum, dB ; valeur par défaut : 60 |
Les couleurs sont relatives au maximum de chaque image. Comparez les valeurs CSV pour confronter plusieurs essais. La première colonne contient la distance ; les suivantes, les échos complexes de chaque faisceau. Gardez le fichier d'angles avec les données et surveillez l'espace disque.
Scènes et observations






Images et vidéos : POSIM Notion Wiki. Les références et licences donnent les attributions de DAVE et du modèle sonar. Utilisez les commandes et les noms de topics des blocs de cette page.