added a publisher for robot planned paths visualized in rviz