Systems and methods for navigating a vehicle
Systems and methods are provided for vehicle navigation. In one implementation, a processing device may be configured to obtain a planned driving action for accomplishing a navigational goal of a host vehicle; receive sensor data from an environment surrounding the host vehicle; identify a target vehicle moving in the environment and a velocity of the target vehicle; calculate a stopping distance and a predicted trajectory for the target vehicle; calculate a planned trajectory for the host vehicle corresponding to the planned driving action; identify an intersection of the planned trajectory for the host vehicle with the predicted trajectory for the target vehicle; determine a braking action of the host vehicle to comply with a safety requirement; and cause the braking action to be applied to decelerate the host vehicle to change the planned trajectory, until the changed trajectory does not intersect the predicted trajectory of the target vehicle.
1. At least one non-transitory machine-readable storage medium comprising instructions, which when executed by processor circuitry of a computing device, cause the processor circuitry to perform operations to:
obtain a planned driving action for accomplishing a navigational goal of a host vehicle;
receive, from a sensor device, sensor data representative of an environment surrounding the host vehicle;
identify, from the sensor data, a target vehicle moving in the environment and a current velocity of the target vehicle;
calculate, based on the current velocity of the target vehicle and a maximum deceleration of the target vehicle, a stopping distance for the target vehicle to reach a complete stop;
calculate a predicted trajectory for the target vehicle to reach the complete stop;
calculate a planned trajectory for the host vehicle corresponding to the planned driving action;
identify an intersection of the planned trajectory for the host vehicle with the predicted trajectory for the target vehicle;
determine a braking action of the host vehicle to comply with a safety requirement, the braking action to apply at least a minimum braking amount that is less than a maximum braking amount of the host vehicle, wherein the safety requirement includes a stopping distance for the host vehicle to come to a complete stop that is less than the stopping distance for the target vehicle; and
cause the braking action to be applied in the host vehicle, in response to identifying the intersection of the planned trajectory for the host vehicle with the predicted trajectory for the target vehicle, the braking action to decelerate the host vehicle to change the planned trajectory of the host vehicle into a changed trajectory, and the braking action to be applied in the host vehicle until the changed trajectory of the host vehicle does not intersect the predicted trajectory of the target vehicle.
2. The storage medium of claim 1 , wherein the maximum deceleration of the target vehicle is provided from a maximum braking capability of the target vehicle.
3. The storage medium of claim 1 , wherein the braking action enables the host vehicle to come to a stop without using the maximum braking amount of the host vehicle.
4. The storage medium of claim 1 , wherein the planned driving action includes continuing the planned trajectory for the host vehicle.
5. The storage medium of claim 1 , the instructions further to cause the processor circuitry to perform operations to:
determine a steering action of the host vehicle to comply with the safety requirement; and
cause the steering action to be applied in the host vehicle, to laterally change the planned trajectory of the host vehicle.
6. The storage medium of claim 1 , wherein the planned driving action is part of a merge or lane change maneuver.
7. The storage medium of claim 1 , wherein the planned driving action is part of a following maneuver.
8. The storage medium of claim 1 , wherein the sensor device includes a camera, and wherein the sensor data includes at least one image.
9. The storage medium of claim 1 , wherein the sensor device includes at least one of a LIDAR system or a RADAR system, and wherein the sensor data includes data from the at least one of the LIDAR system or the RADAR system.
10. A computing device, comprising:
at least one interface to receive sensor data from a sensor device, the sensor data representative of an environment surrounding a host vehicle; and
at least one processor configured to perform operations to:
obtain a planned driving action for accomplishing a navigational goal of the host vehicle;
identify, from the sensor data, a target vehicle moving in the environment and a current velocity of the target vehicle;
calculate, based on the current velocity of the target vehicle and a maximum deceleration of the target vehicle, a stopping distance for the target vehicle to reach a complete stop;
calculate a predicted trajectory for the target vehicle to reach the complete stop;
calculate a planned trajectory for the host vehicle corresponding to the planned driving action;
identify an intersection of the planned trajectory for the host vehicle with the predicted trajectory for the target vehicle;
determine a braking action of the host vehicle to comply with a safety requirement, the braking action to apply at least a minimum braking amount that is less than a maximum braking amount of the host vehicle, wherein the safety requirement includes a stopping distance for the host vehicle to come to a complete stop that is less than the stopping distance for the target vehicle; and
cause the braking action to be applied in the host vehicle, in response to identifying the intersection of the planned trajectory for the host vehicle with the predicted trajectory for the target vehicle, the braking action to decelerate the host vehicle to change the planned trajectory of the host vehicle into a changed trajectory, and the braking action to be applied in the host vehicle until the changed trajectory of the host vehicle does not intersect the predicted trajectory of the target vehicle.
11. The computing device of claim 10 , wherein the maximum deceleration of the target vehicle is provided from a maximum braking capability of the target vehicle.
12. The computing device of claim 10 , wherein the braking action enables the host vehicle to come to a stop without using the maximum braking amount of the host vehicle.
13. The computing device of claim 10 , wherein the planned driving action includes continuing the planned trajectory for the host vehicle.
14. The computing device of claim 10 , the at least one processor further configured to perform operations to:
determine a steering action of the host vehicle to comply with the safety requirement; and
cause the steering action to be applied in the host vehicle, to laterally change the planned trajectory of the host vehicle.
15. The computing device of claim 10 , wherein the planned driving action is part of a merge or lane change maneuver.
16. The computing device of claim 10 , wherein the planned driving action is part of a following maneuver.
17. The computing device of claim 10 , wherein the sensor device includes a camera, and wherein the sensor data includes at least one image.
18. The computing device of claim 10 , wherein the sensor device includes at least one of a LIDAR system or a RADAR system, and wherein the sensor data includes data from the at least one of the LIDAR system or the RADAR system.