Systems and methods for navigating a vehicle
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 following distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken; determine a host vehicle braking distance based on a braking capability, acceleration capability, and speed of the host vehicle; determine a target vehicle braking distance, based on a speed and maximum braking capability of the target vehicle; and implement the planned navigational action when the predicted following distance is greater than a minimum safe longitudinal distance based on the determined host vehicle braking distance and the determined target vehicle braking 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 following distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
identify a defined braking capability of the host vehicle, a defined acceleration capability of the host vehicle, and a longitudinal speed of the host vehicle;
determine a host vehicle braking distance based on an evaluation of: (i) the defined braking capability of the host vehicle, (ii) the defined acceleration capability of the host vehicle, and (iii) the longitudinal speed of the host vehicle, wherein the defined braking capability of the host vehicle comprises a minimum braking rate that is less than a maximum braking rate of the host vehicle, wherein the minimum braking rate is identified to be applied by the host vehicle as at least an initial braking force used to decelerate within the host vehicle braking distance, and wherein the minimum braking rate is identified to be applied by the host vehicle as a lower limit of an amount of braking force used to decelerate throughout the host vehicle braking distance;
determine a target vehicle braking distance, based on an evaluation of: (i) a longitudinal speed of the target vehicle and (ii) a maximum braking capability of the target vehicle; and
cause the host vehicle to implement the planned navigational action when the predicted following distance of the planned navigational action is greater than a minimum safe longitudinal distance, wherein the minimum safe longitudinal distance is calculated based on the determined host vehicle braking distance and the determined target vehicle braking distance.
2. The system of claim 1 , wherein the minimum safe longitudinal distance includes an acceleration distance that corresponds to a distance the host vehicle can travel over a time period at a maximum acceleration capability of the host vehicle, starting from the identified longitudinal speed of the host vehicle.
3. The system of claim 1 , wherein the minimum safe longitudinal distance is further calculated based on a response time associated with the host vehicle.
4. The system of claim 1 , wherein the defined braking capability of the host vehicle is based on weather and road conditions of the environment.
5. The system of claim 1 , wherein the longitudinal speed of the target vehicle is determined from the sensing data.
6. The system of claim 1 , wherein the 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 following distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
identifying a defined braking capability of the host vehicle, a defined acceleration capability of the host vehicle, and a longitudinal speed of the host vehicle;
determining a host vehicle braking distance based on an evaluation of: (i) the defined braking capability of the host vehicle, (ii) the defined acceleration capability of the host vehicle, and (iii) the longitudinal speed of the host vehicle, wherein the defined braking capability of the host vehicle comprises a minimum braking rate that is less than a maximum braking rate of the host vehicle, wherein the minimum braking rate is identified to be applied by the host vehicle as at least an initial braking force used to decelerate within the host vehicle braking distance, and wherein the minimum braking rate is identified to be applied by the host vehicle as a lower limit of an amount of braking force used to decelerate throughout the host vehicle braking distance;
determining a target vehicle braking distance, based on an evaluation of: (i) a longitudinal speed of the target vehicle and (ii) a maximum braking capability of the target vehicle; and
causing the host vehicle to implement the planned navigational action when the predicted following distance of the planned navigational action is greater than a minimum safe longitudinal distance, wherein the minimum safe longitudinal distance is calculated based on the determined host vehicle braking distance and the determined target vehicle braking distance.
10. The machine-readable storage medium of claim 9 , wherein the minimum safe longitudinal distance includes an acceleration distance that corresponds to a distance the host vehicle can travel over a time period at a maximum acceleration capability of the host vehicle, starting from the identified longitudinal speed of the host vehicle.
11. The machine-readable storage medium of claim 9 , wherein the minimum safe longitudinal distance is further calculated based on a response time associated with the host vehicle.
12. The machine-readable storage medium of claim 9 , wherein the defined braking capability of the host vehicle is based on weather and road conditions of the environment.
13. The machine-readable storage medium of claim 9 , wherein the longitudinal speed of the target vehicle is determined from the sensing data.
14. The machine-readable storage medium of claim 13 , wherein the 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 following distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
identifying a defined braking capability of the host vehicle, a defined acceleration capability of the host vehicle, and a longitudinal speed of the host vehicle;
determining a host vehicle braking distance based on an evaluation of: (i) the defined braking capability of the host vehicle, (ii) the defined acceleration capability of the host vehicle, and (iii) the longitudinal speed of the host vehicle, wherein the defined braking capability of the host vehicle comprises a minimum braking rate that is less than a maximum braking rate of the host vehicle, wherein the minimum braking rate is identified to be applied by the host vehicle as at least an initial braking force used to decelerate within the host vehicle braking distance, and wherein the minimum braking rate is identified to be applied by the host vehicle as a lower limit of an amount of braking force used to decelerate throughout the host vehicle braking distance;
determining a target vehicle braking distance, based on an evaluation of: (i) a longitudinal speed of the target vehicle and (ii) a maximum braking capability of the target vehicle; and
causing the host vehicle to implement the planned navigational action when the predicted following distance of the planned navigational action is greater than a minimum safe longitudinal distance, wherein the minimum safe longitudinal distance is calculated based on the determined host vehicle braking distance and the determined target vehicle braking distance.
18. The apparatus of claim 17 , further comprising:
sensing means for capturing the sensing data.