| CPC G01C 21/3407 (2013.01) [G01C 21/3461 (2013.01); G05D 1/0278 (2013.01); G05D 1/248 (2024.01); G07C 5/0816 (2013.01); G07C 5/0841 (2013.01); G08G 1/0962 (2013.01); G08G 1/096716 (2013.01); G08G 1/096725 (2013.01); G08G 1/096741 (2013.01); G08G 1/096775 (2013.01); G01S 19/14 (2013.01)] | 14 Claims |

|
1. A system, comprising:
an interface device in a vehicle configured to generate feedback; and a controller connected to the interface device, the controller being configured to:
determine a set of starting vehicle parameters of a vehicle by accessing a database to retrieve vehicle characteristic data and accessing one or more vehicle position sensors located on the vehicle to determine the vehicle starting position;
determine a set of target destination parameters for the vehicle, the target destination parameters including a target location;
access a distributed objects database including data regarding usable routes from the vehicle starting position to the target destination and the presence of potential hazards, and on the basis of this information:
calculate a path from the vehicle starting position to the target location;
determine, using the one or more vehicle position sensors, a vehicle trajectory;
calculate deviation between the vehicle trajectory and path;
determine at least in part on the basis of vehicle characteristic data and comparing the deviation of the vehicle trajectory and the path with historical data regarding the movement of previous vehicles to the target destination, whether the vehicle can return to the path, and if not;
directing the interface device to display an error message to a vehicle operator, and access the distributed object database, and the basis of the accessed data and a current determination of vehicle position, determine a new path to the target.
|