I'm trying to plan routes in ROS using OSM data and show the results in Rviz, using Python. Until now, my result is the following one:
Correct path computed by the algorithm shown in Rviz:
Now, what I need is to create a marker or something that follows this highlighted path (simulating a car moving on it).
The idea of my project is to simulate a car moving in the correct path and if the car goes to other street while moving because any reason (I will probably intentionally indicate by code that the car deviates), the algorithm is executed again to replan the route from the place the car is to the same final position.
Is there any way to do that simulation of the car moving in rviz?
I am very grateful for your contributions!