Systems and methods for navigating with safe distances
Systems and methods are provided for vehicle navigation. In one implementation, a system may comprise an interface to obtain sensing data of an environment of the host vehicle. A processing device may be configured to determine a planned navigational action for the host vehicle; identify a target vehicle in the environment of the host vehicle; predict a resulting distance between the host and target vehicles if the planned action were taken; determine a host vehicle stopping distance based on a braking rate, maximum acceleration capability, and current speed of the host vehicle; determine a target vehicle stopping distance based on a braking rate and current speed of the target vehicle; and continue with the planned navigational action while the predicted distance is greater than a minimum safe longitudinal distance calculated based on the host vehicle stopping distance and the target vehicle stopping distance.
1. An automated driving system for a host vehicle, the system comprising:
an interface to obtain sensing data of an environment in a vicinity of the host vehicle, the sensing data captured from at least one sensor device of the host vehicle; and
at least one processing device configured to:
determine a planned navigational action for accomplishing a navigational goal of the host vehicle;
identify, from the sensing data, a target vehicle in the environment of the host vehicle;
predict a distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
identify a braking rate of the host vehicle, a maximum acceleration capability of the host vehicle, a current longitudinal speed of the host vehicle, and a response time of the host vehicle to apply the braking rate;
determine a host vehicle stopping distance to bring the host vehicle to a stop, based on an evaluation of: (i) the identified braking rate of the host vehicle, (ii) the maximum acceleration capability of the host vehicle, (iii) the current longitudinal speed of the host vehicle, and (iv) the response time of the host vehicle to apply the identified braking rate, wherein the identified braking rate of the host vehicle is a submaximal braking rate that is less than a maximum braking capability of the host vehicle;
identify a braking rate of the target vehicle and a current longitudinal speed of the target vehicle;
determine a target vehicle stopping distance to bring the target vehicle to a stop, based on an evaluation of: (i) the identified braking rate of the target vehicle and (ii) the current longitudinal speed of the target vehicle; and
cause the host vehicle to continue with the planned navigational action while the predicted distance of the planned navigational action is greater than a minimum safe longitudinal distance, wherein the minimum safe longitudinal distance is calculated based on: (i) the host vehicle stopping distance, (ii) the target vehicle stopping distance, and (iii) an acceleration distance that corresponds to a distance the host vehicle is capable to travel during the response time at the maximum acceleration capability of the host vehicle, starting from the current longitudinal speed of the host vehicle.
2. The system of claim 1 , wherein the planned navigational action includes the target vehicle traveling toward the host vehicle in a lane occupied by the host vehicle.
3. The system of claim 1 , wherein the identified braking rate of the host vehicle is limited based on at least one condition of the host vehicle or at least one weather and road condition of the environment.
4. The system of claim 1 , wherein the identified braking rate of the target vehicle is limited based on at least one characteristic of the target vehicle associated with braking capability or at least one weather and road condition of the environment.
5. The system of claim 1 , wherein the current longitudinal speed of the target vehicle is determined from the sensing data.
6. The system of claim 5 , wherein the current longitudinal speed of the target vehicle is determined from output from at least one of a LIDAR system or a RADAR system of the host vehicle.
7. The system of claim 1 , wherein the planned navigational action causes at least one of steering, braking, or accelerating in the host vehicle.
8. The system of claim 1 , wherein the at least one sensor device includes a camera, and wherein the sensing data includes at least one image captured from the camera.
9. At least one non-transitory machine-readable storage medium comprising instructions stored thereupon, which when executed by a processor of a navigation system of a host vehicle, cause the processor to perform operations comprising:
obtaining sensing data of an environment in a vicinity of the host vehicle, the sensing data captured from at least one sensor device of the host vehicle;
determining a planned navigational action for accomplishing a navigational goal of the host vehicle;
identifying, from the sensing data, a target vehicle in the environment of the host vehicle;
predicting a distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
identifying a braking rate of the host vehicle, a maximum acceleration capability of the host vehicle, a current longitudinal speed of the host vehicle, and a response time of the host vehicle to apply the braking rate;
determining a host vehicle stopping distance to bring the host vehicle to a stop, based on an evaluation of: (i) the identified braking rate of the host vehicle, (ii) the maximum acceleration capability of the host vehicle, (iii) the current longitudinal speed of the host vehicle, and (iv) the response time of the host vehicle to apply the identified braking rate, wherein the identified braking rate of the host vehicle is a submaximal braking rate that is less than a maximum braking capability of the host vehicle;
identifying a braking rate of the target vehicle and a current longitudinal speed of the target vehicle;
determining a target vehicle stopping distance to bring the target vehicle to a stop, based on an evaluation of (i) the identified braking rate of the target vehicle and (ii) the current longitudinal speed of the target vehicle; and
causing the host vehicle to continue with the planned navigational action while the predicted distance of the planned navigational action is greater than a minimum safe longitudinal distance, wherein the minimum safe longitudinal distance is calculated based on; (i) the host vehicle stopping distance, (ii) the target vehicle stopping distance, and (iii) an acceleration distance that corresponds to a distance the host vehicle is capable to travel during the response time at the maximum acceleration capability of the host vehicle, starting from the current longitudinal speed of the host vehicle.
10. The machine-readable storage medium of claim 9 , wherein the planned navigational action includes the target vehicle traveling toward the host vehicle in a lane occupied by the host vehicle.
11. The machine-readable storage medium of claim 9 , wherein the identified braking rate of the host vehicle is limited based on at least one condition of the host vehicle or at least one weather and road condition of the environment.
12. The machine-readable storage medium of claim 9 , wherein the identified braking rate of the target vehicle is limited based on at least one characteristic of the target vehicle associated with braking capability or at least one weather and road condition of the environment.
13. The machine-readable storage medium of claim 9 , wherein the current longitudinal speed of the target vehicle is determined from the sensing data.
14. The machine-readable storage medium of claim 13 , wherein the current longitudinal speed of the target vehicle is determined from output from at least one of a LIDAR system or a RADAR system of the host vehicle.
15. The machine-readable storage medium of claim 9 , wherein the planned navigational action causes at least one of steering, braking, or accelerating in the host vehicle.
16. The machine-readable storage medium of claim 9 , wherein the at least one sensor device includes a camera, and wherein the sensing data includes at least one image captured from the camera.
17. An apparatus, comprising:
means for obtaining sensing data of an environment in a vicinity of a host vehicle, the sensing data captured from at least one sensor device of the host vehicle; and
at least one processing means for:
determining a planned navigational action for accomplishing a navigational goal of the host vehicle;
identifying, from the sensing data, a target vehicle in the environment of the host vehicle;
predicting a distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
identifying a braking rate of the host vehicle, a maximum acceleration capability of the host vehicle, a current longitudinal speed of the host vehicle, and a response time of the host vehicle to apply the braking rate;
determining a host vehicle stopping distance to bring the host vehicle to a stop, based on an evaluation of: (i) the identified braking rate of the host vehicle, (ii) the maximum acceleration capability of the host vehicle, (iii) the current longitudinal speed of the host vehicle, and (iv) the response time of the host vehicle to apply the identified braking rate, wherein the identified braking rate of the host vehicle is a submaximal braking rate that is less than a maximum braking capability of the host vehicle;
identifying a braking rate of the target vehicle and a current longitudinal speed of the target vehicle;
determining a target vehicle stopping distance to bring the target vehicle to a stop, based on an evaluation of: (i) the identified braking rate of the target vehicle and (ii) the current longitudinal speed of the target vehicle; and
causing the host vehicle to continue with the planned navigational action while the predicted distance of the planned navigational action is greater than a minimum safe longitudinal distance, wherein the minimum safe longitudinal distance is calculated based on; (i) the host vehicle stopping distance, (ii) the target vehicle stopping distance, and (iii) an acceleration distance that corresponds to a distance the host vehicle is capable to travel during the response time at the maximum acceleration capability of the host vehicle, starting from the current longitudinal speed of the host vehicle.
18. The apparatus of claim 17 , further comprising:
sensing means for capturing the sensing data.