planner working without rviz