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

Geografische Koordinaten

Das ROS-Plugin SphericalCoords verwaltet den geografischen Weltursprung und rechnet zwischen lokalen kartesischen und geografischen Koordinaten (Breiten-/Längengrad und Höhe) um.

Konfigurierte Welt starten

Im für Ihre Installation vorbereiteten Terminal A:

ros2 launch posim_demos posim_world.launch.py \
  world_name:=posim_bimanual_example headless:=false

Im vorbereiteten Terminal B:

ros2 service list -t
ros2 service call /gz/get_origin_spherical_coordinates \
  posim_interfaces/srv/GetOriginSphericalCoord '{}'

Die Beispiel-SDF setzt 35.074823° Breite und 129.084798° Länge. Die Antwort zeigt den Ursprung der laufenden Welt.

SDF-Integration und Parameter

Platzieren Sie beide Blöcke direkt unter <world>:

<spherical_coordinates>
  <surface_model>EARTH_WGS84</surface_model>
  <world_frame_orientation>ENU</world_frame_orientation>
  <latitude_deg>35.074823</latitude_deg>
  <longitude_deg>129.084798</longitude_deg>
  <elevation>0</elevation>
  <heading_deg>0</heading_deg>
</spherical_coordinates>
<plugin filename="SphericalCoords"
        name="posim_ros_gz_plugins::SphericalCoords"/>

Das Plugin liest die Weltkoordinateneinstellungen und hat keine eigenen SDF-Parameter. Seine vier Servicepfade liegen fest unter /gz/. Außerhalb einer Welt oder ohne geografische Konfiguration meldet es einen Fehler und lässt die Services deaktiviert.

Weltfeld Bedeutung Beispiel
surface_model Referenzellipsoid EARTH_WGS84
world_frame_orientation Achsenkonvention ENU
latitude_deg, longitude_deg Ursprung, Grad 35.074823, 129.084798
elevation Höhe des Ursprungs, m 0
heading_deg Richtungsversatz, Grad 0

Definieren Sie einen ausdrücklichen Ursprung. Siehe Plugin und Beispielwelt.

Services

Die Typen liegen in posim_interfaces/srv. Winkel sind in Grad, lokale Koordinaten und Höhe in Metern angegeben.

Service-Endung unter /gz/ Typ Anfrage
get_origin_spherical_coordinates GetOriginSphericalCoord Leer
set_origin_spherical_coordinates SetOriginSphericalCoord latitude_deg, longitude_deg, altitude
transform_to_spherical_coordinates TransformToSphericalCoord input: {x, y, z}
transform_from_spherical_coordinates TransformFromSphericalCoord latitude_deg, longitude_deg, altitude

Alle Werte müssen endlich sein. Breitengrade reichen von −90° bis 90°, Längengrade von −180° bis 180°. Eine ungültige Ursprungsänderung liefert success: false und erhält den Ursprung. Fehlgeschlagene Umrechnungen liefern NaN-Koordinaten; prüfen Sie sie vor der Nutzung im Controller.

Lokale Position umrechnen

ros2 service call /gz/transform_to_spherical_coordinates \
  posim_interfaces/srv/TransformToSphericalCoord \
  '{input: {x: 100.0, y: 200.0, z: 3.0}}'

Die Antwort enthält Breite, Länge und Höhe. Übergeben Sie diese an den inversen Service und vergleichen Sie output mit dem Ausgangsvektor. So prüfen Sie Ursprung und Achsenkonvention.

Ursprung ändern

ros2 service call /gz/set_origin_spherical_coordinates \
  posim_interfaces/srv/SetOriginSphericalCoord \
  '{latitude_deg: 35.074823, longitude_deg: 129.084798, altitude: 0.0}'

Die Änderung passt die Zuordnung lokaler zu geografischen Positionen an. Stimmen Sie Gelände, Weltausrichtung, Höhenbezug und Controller darauf ab. Die Umrechnung verwendet Gazebo; berücksichtigen Sie den in SDF eingestellten Richtungsversatz und die Orientierung.