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

USBL-Positionierung

USBL (Ultra-Short Baseline) bestimmt Unterwasserpositionen mit akustischen Signalen. Dieses Beispiel verbindet einen Transceiver mit zwei Transpondern. Fragen Sie alle Transponder ab oder wählen Sie einen anhand seiner ID.

Beispielwelt starten

Im für Ihre Installation vorbereiteten Terminal A:

ros2 launch posim_demos posim_world.launch.py \
  world_name:=usbl_tutorial headless:=false
USBL-Beispiel: ein Transceiver und zwei Transponder.
USBL-Beispiel: ein Transceiver und zwei Transponder.

Die Welt enthält bereits alle drei Geräte. Empfangen Sie ihre Positionen im vorbereiteten Terminal B:

ros2 topic echo /USBL/transceiver_manufacturer_168/transponder_location \
  posim_interfaces/msg/Location --once
ros2 topic echo /USBL/transceiver_manufacturer_168/transponder_location_cartesian \
  posim_interfaces/msg/Location --once

Beide Nachrichten enthalten transponder_id, ihre Felder haben jedoch unterschiedliche Bedeutungen:

Ausgabe x y z
transponder_location Horizontalwinkel, Grad Entfernung, m Höhenwinkel, Grad
transponder_location_cartesian Relatives x, m Relatives y, m Relatives z, m

Die Richtungen beruhen auf der Differenz der Weltpositionen. Der Horizontalwinkel beträgt 0° in Richtung +x und 90° nach +y; positive Höhenwinkel zeigen nach +z. Berücksichtigen Sie diese Achsen beim Kombinieren mit Daten im Fahrzeugkoordinatensystem.

SDF-Integration

Setzen Sie den Transceiver in das Modell box. Jede ID entspricht dem Modell an derselben Stelle in transponder_attached_object:

<plugin filename="UsblTransceiver" name="posim_gz_sensor_plugins::UsblTransceiver">
  <namespace>USBL</namespace>
  <transceiver_device>transceiver_manufacturer</transceiver_device>
  <transceiver_ID>168</transceiver_ID>
  <transponder_device>transponder_manufacturer</transponder_device>
  <transponder_ID>1,2</transponder_ID>
  <transponder_attached_object>sphere,sphere2</transponder_attached_object>
  <sound_speed>1540</sound_speed>
  <enable_ping_scheduler>true</enable_ping_scheduler>
  <ping_frequency>0.5</ping_frequency>
  <interrogation_mode>common</interrogation_mode>
</plugin>

Setzen Sie diesen Transponder in sphere und einen zweiten in sphere2 mit transponder_ID gleich 2. Transceivername, ID und Namespace müssen an beiden Enden übereinstimmen:

<plugin filename="UsblTransponder" name="posim_gz_sensor_plugins::UsblTransponder">
  <namespace>USBL</namespace>
  <transceiver_device>transceiver_manufacturer</transceiver_device>
  <transceiver_ID>168</transceiver_ID>
  <transceiver_model>box</transceiver_model>
  <transponder_device>transponder_manufacturer</transponder_device>
  <transponder_ID>1</transponder_ID>
  <sound_speed>1540</sound_speed>
  <mu>0</mu>
  <sigma>0</sigma>
</plugin>

Parameter

Parameter Gerät Bedeutung und Standard
namespace Beide Erforderlicher Namespace, etwa USBL
transceiver_device, transceiver_ID Beide Erforderlicher Gerätename und ID für die Pfade
transponder_device, transponder_ID Beide Erforderlicher Name und ID; der Transceiver akzeptiert kommagetrennte IDs
transponder_attached_object Transceiver Erforderliche kommagetrennte Modellnamen in ID-Reihenfolge
transceiver_model Transponder Erforderlicher Transceiver-Modellname für die Positionsabfrage
sound_speed Beide Referenzschallgeschwindigkeit bei 10 °C und z = 0, m/s; 1540, endlich und positiv
enable_ping_scheduler Transceiver Erforderlicher boolescher Wert; false nutzt manuelle Pings
ping_frequency Transceiver Rate in Simulationszeit, Hz; 1, Beispiel 0.5; endlich und positiv
interrogation_mode Transceiver common oder individual; Standard common
mu, sigma Transponder Mittelwert und Standardabweichung des Positionsrauschens, m; 0 und 1, Beispiel 0 und 0; endlich, sigma ≥ 0

Verwenden Sie vorhandene Modelle, eindeutige IDs und gleich lange ID-/Modelllisten. IDs sind Dezimalzahlen von 0 bis 2147483647, ohne Vorzeichen oder führende Nullen. Jedes Plugin benötigt ein Modell mit einem Link. Die vollständige SDF enthält Geometrie und Platzierung.

Ungültige Konfiguration lässt das Plugin inaktiv. Unbekannte Kanäle oder Befehlsziele werden ignoriert; bei einem unbekannten Kanal bleibt die bisherige Auswahl erhalten. Der erste gelistete Transponder ist der Startkanal. Geplante Pings pausieren mit der Simulation und werden höchstens einmal pro Update gesendet.

Schalllaufzeit

Jede Abfrage hat zwei Wege: Anfrage zum Transponder und Positionsantwort zurück zum Transceiver. Die jeweilige Verzögerung ist Entfernung geteilt durch die Schallgeschwindigkeit des betreffenden Geräts.

Die effektive Geschwindigkeit lautet sound_speed + 0.017 × depth + 4 × (temperature − 10). Einheiten sind m/s, Tiefe in m unter z = 0 und Temperatur in °C. Über Wasser ist die Tiefe null. Die Standardtemperatur beträgt 10 °C.

Veröffentlichen Sie std_msgs/msg/Float64 auf /USBL/transceiver_manufacturer_168/temperature oder /USBL/transponder_manufacturer_1/temperature. Änderungen gelten für spätere Teilstrecken. Nichtendliche Temperaturen sowie Änderungen mit nichtpositiver oder nichtendlicher Geschwindigkeit werden ignoriert.

Die Näherung folgt der DOSITS-Übersicht zur Schallgeschwindigkeit. Entfernungen sind geradlinig, ohne Brechung, Salzgehalt, Mehrwegeausbreitung oder Interferenz. Der Rückweg nutzt die empfangene Position einschließlich des eingestellten Rauschens.

Alle Transponder abfragen

ros2 topic pub --once /USBL/transceiver_manufacturer_168/interrogation_mode \
  std_msgs/msg/String "data: 'common'"
ros2 topic pub --once /USBL/common_interrogation_ping \
  std_msgs/msg/String "data: 'ping'"

common sendet pro geplantem Ping einen Broadcast und kann mehrere IDs auf demselben Topic liefern. Bewahren Sie die ID jeder Antwort auf. Der Transceiver hält den Modus für später hinzukommende Transponder vor.

Einen Transponder auswählen

ros2 topic pub --once /USBL/transceiver_manufacturer_168/channel_switch \
  std_msgs/msg/String "data: '1'"
ros2 topic pub --once /USBL/transponder_manufacturer_1/individual_interrogation_ping \
  std_msgs/msg/String "data: 'ping'"

Ein Kanalwechsel wählt individual; jeder geplante Ping richtet sich an diese ID. Wechseln Sie zurück zu common, um alle Geräte abzufragen.

Anordnung und Abfragemodi

Anordnung von USBL-Sendeempfänger und Transpondern
Anordnung von USBL-Sendeempfänger und Transpondern
Nachrichtenfluss bei gemeinsamer und einzelner Abfrage
Nachrichtenfluss bei gemeinsamer und einzelner Abfrage
Positionsmessungen des Transponders
Positionsmessungen des Transponders

Bilder: POSIM Notion Wiki; DAVE-Zuordnung unter Zitation und Lizenzen. Verwenden Sie die Befehle und Topics dieser Seite.