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.