Modification du message pour utiliser les nav_msgs/Path
 NON TESTE