POSIM v1.0.1Platform for Ocean Simulation · Dokumentation
Dokumentationsmenü
POSIM / Plugin-Referenz

Maritimes GNSS

posim_gz_gnss simuliert einen Satellitenempfänger am Antennenlink eines Modells. Er wandelt dessen Weltposition in geografische Koordinaten um, ergänzt einstellbare gaußsche Fehler und veröffentlicht Position, Geschwindigkeit, Zeitstempel und Zustand in einer gemeinsamen Nachricht. Empfangsverlust unter Wasser, ausdrückliche Blockierung, Wiedererfassung und Latenz sind berücksichtigt.

Empfänger bauen und anbringen

Im für Ihre Installation vorbereiteten Terminal A; unter macOS im Linux-Terminal des RDP-Desktops:

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

Das Modell benötigt einen physischen Antennenlink, meist gnss_link, an der gewünschten Position und mit Verbindung zum Fahrzeug. Die Welt braucht WGS-84-Koordinaten. Fügen Sie dies in die Modell-SDF ein:

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

Passen Sie Link und Topic an Ihren Roboter an. Einen Roboter erstellen erklärt das Vorbereiten und Starten eines Modells.

Die Profile geben Positionen relativ zu base_link vor: WAM-V z = 1.8 m, BlueROV2 0.3 m und REXROV 0.8 m. WAM-V und die drei BlueROV2-Profile aktivieren den Empfänger; REXROV deaktiviert ihn standardmäßig. Die Profile enthalten Montagedaten: Link und Plugin müssen in das Modell eingebaut werden. WAM-V benötigt außerdem das externe Wave-Sim-Modell.

BlueROV2, BlueROV2 Heavy und die Sonarvariante enthalten den Empfänger und den Adapter marine_gnss_input. Bei aktiviertem ArduSub ersetzt MAVROS GPSINPUT das synthetische SITL-GPS. Der Adapter wandelt ENU-Geschwindigkeit in NED und mit dem installierten GeographicLib-Datensatz WGS-84-Ellipsoidhöhe in EGM96-Meereshöhe um. Untergetauchte, blockierte, ungültige, zukünftige oder über 1 s alte Messungen melden keine Positionslösung. Die Satellitenzahl ist bei gültiger Position unbekannt (255); Satellitengeometrie und DOP werden nicht berechnet. Der Demoempfänger verwendet den mittleren Wasserstand z = 0 unabhängig von den sichtbaren Wellen.

Parameter

SDF-Parameter Einheit oder Bedeutung Standard
update_rate Messungen pro Simulationssekunde; >0 bis 100 Hz 5
latency Auslieferungsverzögerung in Simulationssekunden; 0–10 s 0.2
reacquire_seconds Durchgehende Erfassungsdauer über Wasser, s 3
dry_margin Erforderlicher Abstand über Wasser zur Erfassung, m 0.05
horizontal_stddev Standardabweichung der horizontalen Position, m 0.7
vertical_stddev Standardabweichung der vertikalen Position, m 1.2
velocity_stddev Standardabweichung der Geschwindigkeit, m/s 0.1
water_level Mittlere Wasserhöhe z ohne Wellen-Topic, m 0
seed Zufallsstartwert des Empfängers 42
enabled Empfänger aktiviert true
link_name Antennenlink im Modell gnss_link
topic Gazebo-Mess-Topic /model/<model-name>/gnss
wave_topic Optionales Topic mit Wasserhöhen Leer

Numerische Einstellungen müssen endlich sein. Latenz, Erfassungsdauer, Abstand und Standardabweichungen dürfen nicht negativ sein.

Lokale Wasserhöhe

Ohne wave_topic gilt die mittlere Wasserebene. Mit konfiguriertem Topic werden aktuelle lokale Höhen benötigt; fehlende oder ungültige Daten ergeben surface unavailable.

gz.msgs.Double_V enthält in dieser Reihenfolge: Schema 1, Gittergröße, periodische X/Y-Abmessungen, Windgeschwindigkeit und -winkel, Wellensteilheit, Simulationszeit und zeilenweise Höhenwerte.

Richten Sie einen passenden Publisher separat ein. Die Windmetadaten steuern den Empfang nicht.

Messungen und Blockierung lesen

Lesen Sie nach dem Start Ihres konfigurierten Modells sein Topic im vorbereiteten Terminal B:

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

Jede Nachricht enthält 15 Double-Werte. Die Indizes beginnen bei null. Behalten Sie den Aufnahmezeitstempel auch bei verzögerter Positionsausgabe.

Index Feld und Einheit
0–3 Schema 1, Reset-Epoche, Aufnahmezeit in Simulationssekunden, Zustand
4–6 Breite in Grad, Länge in Grad, Höhe in m
7–9 Geschwindigkeit nach Osten, Norden und oben, m/s
10–12 Horizontale/vertikale Positionsvarianz in m², Geschwindigkeitsvarianz in (m/s)²
13–14 Antennenhöhe z in der Welt und lokale Wasserhöhe, m

Zustände: 0 disabled (deaktiviert), 1 submerged (untergetaucht), 2 acquiring (Erfassung), 3 fix (gültige Position), 4 blocked (blockiert), 5 surface unavailable (Wasseroberfläche nicht verfügbar).

Ungültige Messungen enthalten NaN-Koordinaten und -Geschwindigkeiten. Wasserkontakt oder Blockierung verwerfen noch nicht ausgelieferte Messungen. Zur Wiedererfassung muss die Antenne durchgehend oberhalb des erforderlichen Abstands liegen. Ein Reset setzt den Timer zurück, verwirft verzögerte Messungen und erhöht die Epoche.

So blockieren Sie die Antenne; mit false geben Sie sie frei:

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

Auswertung und Prüfung

Vergleichen Sie eine ruhende trockene, untergetauchte, blockierte und wieder freigegebene Antenne. Prüfen Sie Erfassungszeit, Verzögerung, Epoche nach Reset und steigende Zeitstempel. Verwerfen Sie veraltete oder zukünftige Positionen und behandeln Sie ungültige Zustände.

Der mitgelieferte BlueROV2-Adapter versorgt ArduSub; andere ROS-NavSatFix-Empfänger und eigene Autopiloten benötigen weiterhin einen Adapter.

Das Modell basiert auf der Antennenpose. Satellitengeometrie, HF-Ausbreitung, physikalische Mehrwegeausbreitung und akustische Ortung werden nicht berechnet. Eingestellte Genauigkeiten sind Simulationseingaben, keine Herstellerzusicherung. Siehe Implementierung und Paketanleitung.