Updating planner and environment