POSIM v1.0.1Platform for Ocean Simulation · Documentación
Menú de documentación
POSIM / Referencia de plugins

Coordenadas geográficas

El plugin ROS SphericalCoords gestiona el origen geográfico del mundo y convierte posiciones cartesianas locales en latitud, longitud y altitud, y viceversa.

Iniciar un mundo configurado

En la terminal A preparada para tu instalación:

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

En la terminal B preparada:

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

El SDF de ejemplo fija latitud 35.074823° y longitud 129.084798°. Consulta la respuesta para conocer el origen del mundo en ejecución.

Integración SDF y parámetros

Coloca ambos bloques directamente dentro de <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"/>

El plugin lee las coordenadas del mundo y no añade parámetros SDF propios. Sus cuatro servicios tienen rutas fijas bajo /gz/. Si se coloca fuera del mundo o falta su configuración geográfica, informa del error y deja los servicios desactivados.

Campo del mundo Significado Ejemplo
surface_model Elipsoide de referencia EARTH_WGS84
world_frame_orientation Convención de ejes ENU
latitude_deg, longitude_deg Origen, grados 35.074823, 129.084798
elevation Altitud del origen, m 0
heading_deg Desplazamiento de rumbo, grados 0

Define un origen explícito. Consulta el plugin y el mundo de ejemplo.

Servicios

Los tipos pertenecen a posim_interfaces/srv. Los ángulos se expresan en grados; las coordenadas locales y la altitud, en metros.

Sufijo de servicio bajo /gz/ Tipo Solicitud
get_origin_spherical_coordinates GetOriginSphericalCoord Vacía
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

Los valores deben ser finitos. La latitud admite −90° a 90° y la longitud −180° a 180°. Un cambio de origen inválido devuelve success: false y conserva el origen. Una transformación fallida devuelve coordenadas NaN; comprueba el resultado antes de usarlo en un controlador.

Convertir una posición local

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

La respuesta contiene latitud, longitud y altitud. Pasa esos valores al servicio inverso y compara output con el vector inicial para comprobar origen y convención de ejes.

Cambiar el origen

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

El cambio modifica la correspondencia entre posiciones locales y geográficas. Mantén coherentes terreno, orientación del mundo, referencia de altitud y controladores. Las conversiones usan Gazebo; ten en cuenta el rumbo y la orientación configurados en el SDF.