Change Path planner to user current robot speed