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

GNSS marino

posim_gz_gnss simula un ricevitore satellitare sul link dell'antenna del modello. Converte la sua posizione nel mondo in coordinate geografiche, aggiunge errori gaussiani configurabili e pubblica posizione, velocità, timestamp e stato in un unico messaggio. Comprende perdita di ricezione sott'acqua, blocco esplicito, riacquisizione e latenza.

Compilare e montare il ricevitore

Nel terminale A preparato per la tua installazione; su macOS, usa il terminale Linux del desktop 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

Il modello deve avere un link fisico per l'antenna, normalmente gnss_link, posizionato e collegato al veicolo. Il mondo richiede coordinate WGS 84. Inserisci nel SDF del modello:

<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>

Adatta link e topic al robot. La guida Creare un robot spiega come preparare e avviare il modello.

I profili indicano pose rispetto a base_link: WAM-V a z = 1.8 m, BlueROV2 a 0.3 m e REXROV a 0.8 m. WAM-V e i tre profili BlueROV2 abilitano il ricevitore; REXROV lo disabilita per impostazione predefinita. I profili contengono dati di montaggio: link e plugin vanno inseriti nel modello. WAM-V richiede anche il modello esterno Wave Sim.

BlueROV2, BlueROV2 Heavy e la variante sonar includono il ricevitore e l'adattatore marine_gnss_input. Con ArduSub, i messaggi MAVROS GPSINPUT sostituiscono il GPS sintetico di SITL. L'adattatore converte la velocità ENU in NED e, con i dati GeographicLib installati, l'altezza ellissoidica WGS 84 in quota EGM96 sul livello medio del mare. Misure sommerse, bloccate, non valide, future o più vecchie di 1 s indicano assenza di posizione. Il numero di satelliti è sconosciuto (255) anche per una posizione valida; geometria satellitare e DOP non vengono calcolate. Il ricevitore dell'esempio usa il livello medio z = 0 indipendentemente dalle onde visibili.

Parametri

Parametro SDF Unità o significato Predefinito
update_rate Campioni per secondo simulato; >0 fino a 100 Hz 5
latency Ritardo di consegna in secondi simulati; 0–10 s 0.2
reacquire_seconds Tempo continuo di acquisizione fuori dall'acqua, s 3
dry_margin Distanza sopra l'acqua necessaria per acquisire, m 0.05
horizontal_stddev Deviazione standard della posizione orizzontale, m 0.7
vertical_stddev Deviazione standard della posizione verticale, m 1.2
velocity_stddev Deviazione standard della velocità, m/s 0.1
water_level z medio dell'acqua senza topic delle onde, m 0
seed Seme casuale del ricevitore 42
enabled Ricevitore abilitato true
link_name Link dell'antenna nel modello gnss_link
topic Topic Gazebo delle misure /model/<model-name>/gnss
wave_topic Topic facoltativo dell'altezza dell'acqua Vuoto

I valori numerici devono essere finiti. Latenza, tempo di acquisizione, margine e deviazioni standard devono essere non negativi.

Altezza locale dell'acqua

Senza wave_topic, si usa il piano medio dell'acqua. Con un topic configurato, servono campioni locali recenti; dati mancanti o non validi producono surface unavailable.

Il messaggio gz.msgs.Double_V contiene, nell'ordine: schema 1, dimensione della griglia, dimensioni periodiche X/Y, velocità e angolo del vento, ripidezza dell'onda, tempo simulato e altezze per righe.

Configura separatamente un publisher compatibile. I metadati del vento non controllano la ricezione.

Leggere misure e blocco

Dopo aver avviato il modello configurato, leggi il topic nel terminale B preparato:

gz topic -e -t /model/my_robot/gnss

Ogni messaggio contiene 15 numeri in doppia precisione. Gli indici partono da zero. Conserva il timestamp di acquisizione anche quando la posizione arriva in ritardo.

Indice Campo e unità
0–3 Schema 1, epoca di reset, acquisizione in secondi simulati, stato
4–6 Latitudine in gradi, longitudine in gradi, altitudine in m
7–9 Velocità verso est, nord e alto, m/s
10–12 Varianze di posizione orizzontale/verticale in m² e velocità in (m/s)²
13–14 z dell'antenna nel mondo e altezza locale dell'acqua, m

Stati: 0 disabled (disabilitato), 1 submerged (sommerso), 2 acquiring (acquisizione), 3 fix (posizione valida), 4 blocked (bloccato), 5 surface unavailable (superficie non disponibile).

Una misura non valida contiene coordinate e velocità NaN. Contatto con l'acqua o blocco eliminano le misure in attesa. La riacquisizione richiede che l'antenna rimanga continuamente al di sopra del margine richiesto. Il reset cancella timer e campioni ritardati e incrementa l'epoca.

Per bloccare l'antenna; usa false per liberarla:

gz topic -t /model/my_robot/gnss/blocked -m gz.msgs.Boolean -p 'data: true'

Interpretare e verificare

Confronta un'antenna ferma fuori dall'acqua, sommersa, bloccata e ripristinata. Controlla acquisizione, ritardo, epoca dopo il reset e timestamp crescenti. Scarta posizioni obsolete o future e gestisci gli stati non validi.

L'adattatore BlueROV2 incluso alimenta ArduSub; altri utilizzatori ROS NavSatFix e autopiloti personalizzati richiedono ancora un adattatore.

Il modello si basa sulla posa dell'antenna. Non calcola geometria satellitare, propagazione RF, percorsi multipli fisici o posizionamento acustico. Le precisioni impostate sono dati della simulazione, non garanzie del produttore. Vedi implementazione e guida del pacchetto.