ROSified version of RRT Planner