| CPC G01C 21/3492 (2013.01) [G01C 21/3461 (2013.01); G01C 21/3614 (2013.01)] | 17 Claims |
|
1. A route planning device, comprising:
a data interface coupled to a road and traffic data source;
a user interface configured to display a map and receive a route planning request from a user, the route planning request comprising a line of interest on the map;
a processor coupled to the data interface and the user interface, and configured to:
identify the line of interest in response to the route planning request;
acquire, via the data interface, road and traffic information associated with the line of interest from the road and traffic data source; and
calculate, based on the acquired road and traffic information, a navigation route that matches or corresponds to the line of interest and meets or satisfies predefined road and traffic constraints;
wherein the route planning device is in a running autonomous vehicle (AV);
the data interface is a first data interface, and the route planning device further comprises a second data interface coupled to one or more sensors on the running AV; and
the processor is further configured to:
acquire, via the second data interface, real-time sensor data to be fed into a safety driving model,
calculate the navigation route that matches or corresponds to the line of interest and meets or satisfies both the road and traffic constraints and predefined safety driving constraints;
simulate route changing along the line of interest in response to the route planning request;
determine whether the route changing violates the safety driving constraints;
reject the route planning request when it is determined the route changing violates the safety driving constraints; and
accept the route planning request and calculate the navigation route under the road and traffic constraints when it is determined the route changing does not violate the safety driving constraints.
|