Location planner v1.0 and tested