Advanced Construction Vehicle Foxhole Planner