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

Coordinate geografiche

Il plugin ROS SphericalCoords gestisce l'origine geografica del mondo e converte le posizioni cartesiane locali in latitudine, longitudine e altitudine, e viceversa.

Avviare un mondo configurato

Nel terminale A preparato per la tua installazione:

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

Nel terminale B preparato:

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

Il SDF di esempio imposta latitudine 35.074823° e longitudine 129.084798°. Leggi la risposta per conoscere l'origine del mondo in esecuzione.

Integrazione SDF e parametri

Inserisci entrambi i blocchi direttamente in <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"/>

Il plugin legge le coordinate del mondo e non aggiunge parametri SDF propri. I quattro percorsi dei servizi sono fissi sotto /gz/. Fuori da un mondo, oppure senza configurazione geografica, segnala un errore e lascia disattivati i servizi.

Campo del mondo Significato Esempio
surface_model Ellissoide di riferimento EARTH_WGS84
world_frame_orientation Convenzione degli assi ENU
latitude_deg, longitude_deg Origine, gradi 35.074823, 129.084798
elevation Altitudine dell'origine, m 0
heading_deg Scostamento di rotta, gradi 0

Definisci un'origine esplicita. Vedi il plugin e il mondo di esempio.

Servizi

I tipi appartengono a posim_interfaces/srv. Gli angoli sono in gradi; coordinate locali e altitudine in metri.

Suffisso del servizio sotto /gz/ Tipo Richiesta
get_origin_spherical_coordinates GetOriginSphericalCoord Vuota
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

Tutti i valori devono essere finiti. La latitudine va da −90° a 90°, la longitudine da −180° a 180°. Un aggiornamento dell'origine non valido restituisce success: false e conserva l'origine. Una conversione fallita restituisce coordinate NaN: controllale prima di usarle in un controllore.

Convertire una posizione locale

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

La risposta contiene latitudine, longitudine e altitudine. Passale al servizio inverso e confronta output con il vettore iniziale per verificare origine e convenzione degli assi.

Cambiare l'origine

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

Il cambio modifica la corrispondenza tra posizioni locali e geografiche. Mantieni coerenti terreno, orientamento del mondo, riferimento altimetrico e controllori. Le conversioni usano Gazebo: considera rotta e orientamento impostati nel SDF.