POSIM v1.0.1Platform for Ocean Simulation · Documentazione
Menu della documentazione
POSIM / Riferimento dei plugin

Sonar multibeam

Il sonar multibeam di POSIM usa un modello a diffusori puntiformi per generare dati di intensità e distanza e immagini acustiche. Lo stesso plugin offre il calcolo su CPU, WGPU e CUDA. WGPU usa Vulkan su Linux o Metal in un ambiente macOS nativo per lavorare con GPU di produttori diversi. Consulta la configurazione del calcolo.

Avviare un esempio

Prepara i terminali A e B e, se mancano, compila i pacchetti del sonar. Avvia la simulazione in A e osserva i dati in B. Il primo comando sceglie automaticamente il backend; l'esempio dedicato seleziona WGPU e apre anche 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

Il pacchetto posim_multibeam_sonar_demo offre anche un esempio autonomo:

ros2 launch posim_multibeam_sonar_demo multibeam_sonar_demo.launch.py \
  compute_backend:=wgpu
Immagine sonar, nuvola di punti e telecamera in tempo reale in RViz (calcolo CUDA).
Immagine sonar, nuvola di punti e telecamera in tempo reale in RViz (calcolo CUDA).

Esegui un solo esempio alla volta. Sostituisci wgpu con cpu, cuda o auto per cambiare backend. Per il sonar a bordo, scegli bluerov2_heavy_multibeam_sonar con un mondo adatto.

Come funziona il sensore

Gazebo fornisce la geometria della scena. Il modello stima le normali delle superfici, calcola la retrodiffusione acustica, applica la risposta di ricezione e comprime gli echi in celle di distanza. Dati acustici e immagine rappresentano la stessa osservazione. Usa i dati grezzi per l'analisi e conserva le impostazioni di guadagno e visualizzazione.

Un valore positivo di spec/receiveBeamWidth attiva la modalità fisica, che usa le coordinate XYZ misurate da una camera di profondità che copre tutto il campo del sonar. Campioni geometrici, direzioni riceventi e uscite in distanza sono indipendenti. Le celle con centro nel campo ne ripartiscono l'intero angolo solido; le loro aree di superficie proiettate e la risposta ricevente con segno determinano i contributi ai fasci. Il modello usa un impulso Hamming in banda base, con larghezza di banda fissa e picco unitario. L'intervallo di calcolo interno è più lungo dell'intervallo di distanza pubblicato. Il passo di uscita è soundSpeed / (2 × bandwidth); la lunghezza di calcolo non determina il guadagno dell'impulso. L'intervallo di guardia interno non viene pubblicato e non cambia questo passo.

ray/scan/horizontal/samples definisce le colonne geometriche, ray/scan/vertical/rays le righe dell'immagine e beams le direzioni riceventi. La modalità fisica richiede un campo simmetrico inferiore a 180° su ogni asse. I limiti di distanza sono radiali; i pixel fuori dal campo o dai limiti hanno XYZ non valide nella nuvola organizzata. spec/receiveBeamWidth indica la larghezza totale a metà potenza in radianti; spec/receiveGain imposta il guadagno lineare di pressione (predefinito: 1). Una larghezza omessa o nulla seleziona la modalità a griglia predefinita. La modalità fisica supporta CPU e WGPU, ma non CUDA. Non esiste un limite fisso di 4096 campioni di frequenza; le griglie grandi restano soggette alle risorse del motore e alle dimensioni rappresentabili. I coefficienti di diffusione sono generati per immagine e cella geometrica. Il modello descrive echi in banda base, senza propagazione della fase portante né calibrazione dell'ampiezza dell'hardware.

Controllare i dati

Nel terminale B:

ros2 topic list -t
ros2 topic echo /sensor/multibeam_sonar/sonar_image \
  sensor_msgs/msg/Image --once --no-arr --qos-reliability reliable

Configurazione del sensore

Inserisci questi sistemi direttamente in <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"/>

Inserisci il sensore P900 in un <link> del modello:

<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'esempio richiede 512 fasci orizzontali su circa 130°, 300 raggi verticali su circa 12° e una portata di 0.1–10 m. Usa 900 kHz, una larghezza di banda di 29.9 kHz e una velocità del suono di 1500 m/s. I 30 Hz impostati sono la frequenza richiesta: quella ricevuta dipende dal calcolo e dal rendering. Consulta il modello completo.

Parametri di <spec>

Parametro Funzione Valore predefinito Esempio P900
verticalFOV Apertura acustica verticale, gradi 10 12
sonarFreq Frequenza acustica, Hz 900000 900000
bandwidth Larghezza di banda, Hz 29500000 29900
soundSpeed Velocità del suono, m/s 1500 1500
sourceLevel Livello della sorgente, dB 220 220
maxDistance Distanza di elaborazione, m; da allineare alla portata dei raggi 60 10
raySkips Passo di campionamento verticale; intero positivo 10 10
sensorGain Guadagno di ampiezza degli echi nella griglia CPU predefinita; non usato in modalità fisica né da WGPU/CUDA 0.02 0.02
blazingSonarImage Seme casuale basato sull'orologio reale; con false è fisso a 1234 false true
pointCloudTopicName Suffisso del topic Gazebo della nuvola di punti point_cloud Uguale
sonarImageRawTopicName Suffisso del topic ROS degli echi grezzi sonar_image_raw Uguale
sonarImageTopicName Suffisso del topic ROS dell'immagine sonar_image Uguale
frameName Identificatore del sistema di riferimento ottico forward_sonar_optical_link Uguale
writeLog Scrivere CSV in una cartella distinta per ogni esecuzione false false
writeFrameInterval Fotogrammi tra due scritture; intero positivo 10 5
debugFlag Messaggi diagnostici nella console false false
plotScaler Letto e stampato, ma non usato nella generazione dell'immagine 10 Non specificato

Topic e sistemi di riferimento

I suffissi si aggiungono al <topic> del sensore, qui /sensor/multibeam_sonar. La nuvola di punti Gazebo usa gz.msgs.PointCloudPacked; il bridge ROS incluso la rende disponibile come sensor_msgs/msg/PointCloud2. Allinea pointCloudTopicName a sensor_config.py e imposta il riferimento ottico del sonar in frameName.

I file di avvio del BlueView P900 e del sonar BlueROV2 pubblicano una trasformazione identità da world al sistema di riferimento del sonar per la visualizzazione in RViz. Le coordinate della nuvola di punti restano relative al sensore. Questa trasformazione statica non segue il movimento del veicolo e non tiene conto della posizione e dell'orientamento di montaggio del sonar. Per creare mappe in coordinate globali, sostituiscila con una catena di trasformazioni che includa entrambe le pose.

Geometria dei raggi

I valori predefiniti di <ray> sono 256 fasci orizzontali, 3 raggi verticali, angoli orizzontali ±π/4, verticali ±π/8 e portata 0.1–5 m. Gli angoli sono in radianti; con degrees="true" si usano i gradi. Il <reference_frame> facoltativo in <gz:multibeam_sonar> ha posizione e orientamento nulli per impostazione predefinita.

Mantieni completi i blocchi <ray> e <spec>: i valori predefiniti si applicano ai singoli campi. La portata dei raggi e maxDistance devono essere coerenti. L'implementazione definisce la lettura dei parametri e la pubblicazione dei dati.

Confrontare le misure

Disattiva la registrazione quando misuri le prestazioni, a meno che faccia parte dell'esperimento. Segui la guida Configurare e regolare il sonar e conserva i parametri acustici e blazingSonarImage per confrontare le esecuzioni.

Backend di calcolo

Scelta Comportamento
auto Prova CUDA, poi WGPU e infine CPU; scelta predefinita
wgpu Usa un adattatore Vulkan/Metal compatibile; se manca, il sensore non si inizializza
cuda Richiede GPU NVIDIA e backend CUDA compilato e installato; l'inizializzazione fallisce se non sono disponibili
cpu Calcola gli echi sulla CPU; il rendering di Gazebo resta necessario

L'esempio dedicato accetta compute_backend; gli altri avvii leggono POSIM_SONAR_COMPUTE_BACKEND. Controlla la riga Using sonar compute backend: all'avvio. La guida Configurare il sonar spiega la scelta dell'adattatore, i requisiti e le differenze numeriche.

Aggiungere un sensore

  1. Copia models/posim_sensor_models/description/blueview_p900/ con un nuovo identificatore.
  2. Prepara il relativo config/<identificatore>/sensor_config.py. Allinea nomi del modello, link, sistemi di riferimento e topic del bridge.
  3. Imposta campionamento, angoli e portata. Carica nel mondo i due sistemi mostrati sopra; consulta il mondo sonar in SDF per le altre impostazioni.
  4. Prepara il backend di calcolo e il rendering, ricompila il workspace e caricane l'ambiente. Seleziona il sensore tramite gli argomenti di avvio.

Registrare e visualizzare i dati grezzi

Con writeLog=true, ogni sensore crea SonarRawData_<run>_<suffix>/ nella cartella di lavoro del simulatore e ne stampa il percorso. Vi salva CSV numerati e SonarRawData_beam_angles.csv, conservando le registrazioni precedenti. Gli intervalli inferiori a 1 vengono portati a 1. Se la cartella non può essere creata, la registrazione viene disattivata con un messaggio di errore.

Dalla cartella indicata, apri il primo fotogramma:

ros2 run posim_multibeam_sonar_demo plotdata.py SonarRawData_000001.csv

Per salvare i grafici in PNG:

ros2 run posim_multibeam_sonar_demo plotdata.py SonarRawData_000001.csv \
  --output-dir plots --no-show

Lo strumento di visualizzazione si installa anche senza CUDA. Produce una vista sonar e cinque profili di fasci scelti a intervalli regolari, oppure tutti i profili se i fasci sono meno di cinque.

Opzione Effetto
--range-max Distanza massima visualizzata, m
--beam-step Mostrare un fascio ogni N
--dynamic-range Intervallo sotto il massimo, dB; valore predefinito: 60

I colori sono relativi al massimo di ciascun fotogramma: usa i valori CSV per confrontare esecuzioni diverse. La prima colonna contiene le distanze, le altre gli echi complessi dei fasci. Conserva il file degli angoli insieme ai dati e controlla lo spazio occupato su disco.

Scene e osservazioni

Elaborazione del sonar multibeam con diffusione puntiforme
Elaborazione del sonar multibeam con diffusione puntiforme
RGB, profondità, immagine sonar e nuvola di punti della stessa scena
RGB, profondità, immagine sonar e nuvola di punti della stessa scena
Variazione delle immagini nell’esempio sonar
Variazione delle immagini nell’esempio sonar
Misure sonar al variare della scena
Misure sonar al variare della scena
Misure sonar dal BlueROV2
Misure sonar dal BlueROV2
Esplorazione locale della scena con il sonar
Esplorazione locale della scena con il sonar

Immagini e video: POSIM Notion Wiki. Consulta Citazioni e licenze per l'attribuzione di DAVE e del modello sonar. Usa i comandi e i topic riportati nei blocchi di questa pagina.