I have a rosbag file which I can visualize in RVIZ how can I implement a star algorithm on this file?