Constrained path planning of unmanned vehicles