Autonomous vehicle controlled crash
Military convoys sometimes need to push vehicles or obstacles out of the way in order to proceed with their mission. Selecting if pushing is necessary, what can be pushed, and what cannot be pushed as well as the specific maneuver necessary for pushing or creating a controlled crash are important to minimize the damage to the autonomous vehicles as well as to create pathways that are traversable by other autonomous vehicles in the convoy. These tasks are accomplished by evaluating the costs involved in each trajectory that can be navigated by the autonomous convoy and deciding if pushing the obstacle is the preferred path or navigating around the obstacle is the preferred path for the autonomous vehicles. Also, in some cases, several autonomous vehicles simultaneously push the obstacle at the same time.
1. An autonomous vehicle navigation system, comprising:
a plurality of autonomous vehicles, each autonomous vehicle comprising a sensor operable to detect obstacles; and
a planning device in communication with at least one of the plurality of autonomous vehicles, the planning device being operable to execute stored code to:
identify a plurality of possible routes for the plurality of autonomous vehicles to traverse to arrive at a destination;
identify, based on information received from at least one of the sensors, at least one obstacle blocking a first one of the possible routes of the plurality of possible routes;
compute, for each of the routes of the plurality of possible routes and based at least in part on identifying the at least one obstacle blocking the first one of the possible routes of the plurality of possible routes and based at least in part on estimated traversal times, a traversal cost for each of the routes of the plurality of possible routes;
select, based on the computed traversal costs, the first one of the possible routes of the plurality of possible routes; and
causing, in response to the selecting, the plurality of autonomous vehicles to traverse the selected first one of the possible routes of the plurality of possible routes,
wherein the traversal of the selected first one of the possible routes of the plurality of possible routes comprises causing at least one autonomous vehicle of the plurality of autonomous vehicles to contact the at least one obstacle blocking the first one of the possible routes of the plurality of possible routes,
wherein at least one autonomous vehicles of the plurality of autonomous vehicles comprises an instrument operable to detect the forces necessary to move the at least one obstacle.
2. The system of claim 1 , wherein at least one of the sensors comprises at least one of (i) a LADAR sensor, (ii) a ranging sensor, and (iii) an acoustic sensor.
3. The system of claim 1 , wherein the planning device is further operable to execute the stored code to:
calculate, based on the information received from at least one of the sensors, an estimate of the volume of the at least one obstacle.
4. The system of claim 1 , wherein the planning device is further operable to execute the stored code to:
determine, based on information received from at least one of the sensors that is descriptive of the surface of the at least one obstacle, a classification of the density of the at least one obstacle.
5. The system of claim 1 , wherein the computing of the traversal cost for at least one of the routes of the plurality of possible routes is based on information received from the instrument.
6. The system of claim 1 , wherein the computed traversal costs are at least partially based on at least one of (i) an estimated cost of damage to the autonomous vehicle, and (ii) an estimated cost of damage to the at least one obstacle.
7. The system of claim 1 , wherein the causing comprises causing two or more autonomous vehicles to simultaneously push the at least one obstacle.
8. The system of claim 1 , wherein the contact between the at least one autonomous vehicle of the plurality of autonomous vehicles and the at least one obstacle blocking the first one of the possible routes of the plurality of possible routes comprises a movement of the at least one obstacle by the at least one autonomous vehicle exerting the forces necessary to move the at least one obstacle.
9. The system of claim 1 , wherein the contact between the at least one autonomous vehicle of the plurality of autonomous vehicles and the at least one obstacle blocking the first one of the possible routes of the plurality of possible routes comprises a pushing of the at least one obstacle by the at least one autonomous vehicle.
10. A method of autonomous vehicle routing, comprising:
identifying, by a planning device, a plurality of possible routes for at least one autonomous vehicle to traverse to arrive at a destination;
identifying, by a sensor of the at least one autonomous vehicle, at least one stationary obstacle blocking a first one of the possible routes of the plurality of possible routes;
computing, for each of the routes of the plurality of possible routes and based at least in part on the identifying of the at least one stationary obstacle blocking the first one of the possible routes of the plurality of possible routes and based at least in part on estimated traversal times, a traversal cost for each of the routes of the plurality of possible routes;
selecting, based on the computed traversal costs, the first one of the possible routes of the plurality of possible routes;
traversing, by the at least one autonomous vehicle and in response to the selecting, the selected first one of the possible routes of the plurality of possible routes,
measuring, utilizing instrumentation coupled to the at least one autonomous vehicle, a force required to move the at least one stationary obstacle blocking the first one of the possible routes of the plurality of possible routes; and
recomputing, for each of the routes of the plurality of possible routes and based at least in part on the measuring of the force required to move the at least one stationary obstacle blocking the first one of the possible routes of the plurality of possible routes and based at least in part on estimated traversal times, the traversal cost for each of the routes of the plurality of possible routes.
11. The method of claim 10 , further comprising:
reselecting, based on the recomputed traversal costs, a second one of the possible routes of the plurality of possible routes; and
traversing, by the at least one autonomous vehicle and in response to the reselecting, the selected second one of the possible routes of the plurality of possible routes.