A system for path control for a mobile unmanned vehicle in an environment is provided. The system includes: a sensor connected to the mobile unmanned vehicle; the mobile unmanned vehicle configured to initiate a first fail-safe routine responsive to detection of an object in a first sensor region adjacent to the sensor; and a processor connected to the mobile unmanned vehicle. The processor is configured to: generate a current path based on a map of the environment; based on the current path, issue velocity commands to cause the mobile unmanned vehicle to execute the current path; responsive to detection of an obstacle in a second sensor region, initiate a second fail-safe routine in the mobile unmanned vehicle to avoid entry of the obstacle into the first sensor region and initiation of the first fail-safe routine.