Local Planner complete with no PID implementation