Coordonnées géographiques
Le plugin ROS SphericalCoords gère l'origine géographique du monde et convertit les positions cartésiennes locales en latitude, longitude et altitude, et inversement.
Lancer un monde configuré
Dans le terminal A préparé pour votre installation :
ros2 launch posim_demos posim_world.launch.py \
world_name:=posim_bimanual_example headless:=false
Dans le terminal B préparé :
ros2 service list -t
ros2 service call /gz/get_origin_spherical_coordinates \
posim_interfaces/srv/GetOriginSphericalCoord '{}'
Le SDF d'exemple fixe la latitude à 35.074823° et la longitude à 129.084798°. Lisez la réponse pour connaître l'origine du monde en cours.
Intégration SDF et paramètres
Placez ces deux blocs directement dans <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"/>
Le plugin lit les coordonnées du monde et ne possède pas de paramètre SDF propre. Ses quatre services ont des chemins fixes sous /gz/. Placé ailleurs que dans un monde, ou sans configuration géographique, il signale une erreur et laisse les services désactivés.
| Champ du monde | Signification | Exemple |
|---|---|---|
surface_model |
Ellipsoïde de référence | EARTH_WGS84 |
world_frame_orientation |
Convention des axes | ENU |
latitude_deg, longitude_deg |
Origine, degrés | 35.074823, 129.084798 |
elevation |
Altitude de l'origine, m | 0 |
heading_deg |
Décalage de cap, degrés | 0 |
Définissez une origine explicite. Consultez le plugin et le monde d'exemple.
Services
Les types appartiennent à posim_interfaces/srv. Les angles sont en degrés ; les coordonnées locales et l'altitude sont en mètres.
Suffixe du service sous /gz/ |
Type | Requête |
|---|---|---|
get_origin_spherical_coordinates |
GetOriginSphericalCoord |
Vide |
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 |
Les valeurs doivent être finies. La latitude va de −90° à 90°, la longitude de −180° à 180°. Une mise à jour d'origine invalide renvoie success: false sans changer l'origine. Une transformation échouée renvoie des coordonnées NaN ; vérifiez-les avant de les transmettre à un contrôleur.
Convertir une position locale
ros2 service call /gz/transform_to_spherical_coordinates \
posim_interfaces/srv/TransformToSphericalCoord \
'{input: {x: 100.0, y: 200.0, z: 3.0}}'
La réponse contient latitude, longitude et altitude. Passez ces valeurs au service inverse et comparez output au vecteur initial pour vérifier origine et convention des axes.
Changer 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}'
Le changement modifie la correspondance entre positions locales et géographiques. Vérifiez la cohérence entre le terrain, l'orientation du monde, la référence d'altitude et les contrôleurs. Les conversions utilisent Gazebo ; tenez compte du cap et de l'orientation définis dans le SDF.