Infrastructure Planning For Unmanned Vehicle Navigation In Constrained Environments