Added local planner (incomplete version).