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. The processing device may be configured to determine a planned navigational action; identify, a target vehicle in the environment of the host vehicle; predict a distance between the host vehicle and the target vehicle if the planned navigational action was taken; determine a current host vehicle stopping distance based on a braking capability, acceleration capability, and speed of the host vehicle; determine a current target vehicle braking distance based on a speed and braking capability of the target vehicle; and implement the planned navigational action when the predicted distance of the planned navigational action is greater than a minimum safe longitudinal distance calculated based on the current host vehicle stopping distance and the current 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 distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
obtain a current braking capability of the host vehicle, a current acceleration capability of the host vehicle, and a current longitudinal speed of the host vehicle;
determine a current host vehicle stopping distance, based on the current braking capability of the host vehicle, the current acceleration capability of the host vehicle, and the current longitudinal speed of the host vehicle, the current braking capability of the host vehicle comprising a minimum braking rate that is less than a maximum braking rate of the host vehicle, and the current braking capability of the host vehicle limited by at least one condition relating to deceleration of the host vehicle;
obtain a current braking capability of the target vehicle and a current longitudinal speed of the target vehicle, the current braking capability of the target vehicle based on a maximum defined braking rate of the target vehicle;
determine a current target vehicle braking distance, based on the current longitudinal speed of the target vehicle and the current braking capability of the target vehicle; and
cause the host vehicle to implement the planned navigational action when the predicted distance of the planned navigational action is greater than a minimum safe longitudinal distance, the minimum safe longitudinal distance being calculated based on the current host vehicle stopping distance and the current target vehicle braking distance.
2. The system of claim 1 , wherein the minimum safe longitudinal distance is further based on a current 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 current 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 at least one condition relating to deceleration includes a vehicle condition that limits performance of a braking system of the host vehicle.
5. The system of claim 1 , wherein the at least one condition relating to deceleration includes weather and road conditions of the environment.
6. The system of claim 1 , wherein the current longitudinal speed of the target vehicle is determined from the sensing data.
7. The system of claim 6 , 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.
8. The system of claim 1 , wherein the planned navigational action causes at least one of steering, braking, or accelerating in the host vehicle.
9. 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.
10. 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;
obtaining a current braking capability of the host vehicle, a current acceleration capability of the host vehicle, and a current longitudinal speed of the host vehicle;
determining a current host vehicle stopping distance, based on the current braking capability of the host vehicle, the current acceleration capability of the host vehicle, and the current longitudinal speed of the host vehicle, the current braking capability of the host vehicle comprising a minimum braking rate that is less than a maximum braking rate of the host vehicle, and the current braking capability of the host vehicle limited by at least one condition relating to deceleration of the host vehicle;
obtaining a current braking capability of the target vehicle and a current longitudinal speed of the target vehicle, the current braking capability of the target vehicle based on a maximum defined braking rate of the target vehicle;
determining a current target vehicle braking distance, based on the current longitudinal speed of the target vehicle and the current braking capability of the target vehicle; and
causing the host vehicle to implement the planned navigational action when the predicted distance of the planned navigational action is greater than a minimum safe longitudinal distance, the minimum safe longitudinal distance being calculated based on the current host vehicle stopping distance and the current target vehicle braking distance.
11. The machine-readable storage medium of claim 10 , wherein the minimum safe longitudinal distance is further based on a current 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 current longitudinal speed of the host vehicle.
12. The machine-readable storage medium of claim 10 , wherein the minimum safe longitudinal distance is further calculated based on a response time associated with the host vehicle.
13. The machine-readable storage medium of claim 10 , wherein the at least one condition relating to deceleration includes a vehicle condition that limits performance of a braking system of the host vehicle.
14. The machine-readable storage medium of claim 10 , wherein the at least one condition relating to deceleration includes weather and road conditions of the environment.
15. The machine-readable storage medium of claim 10 , wherein the current longitudinal speed of the target vehicle is determined from the sensing data.
16. The machine-readable storage medium of claim 15 , 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.
17. The machine-readable storage medium of claim 10 , wherein the planned navigational action causes at least one of steering, braking, or accelerating in the host vehicle.
18. The machine-readable storage medium of claim 10 , wherein the at least one sensor device includes a camera, and wherein the sensing data includes at least one image captured from the camera.
19. 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;
at least one processing means for:
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;
obtaining a current braking capability of the host vehicle, a current acceleration capability of the host vehicle, and a current longitudinal speed of the host vehicle;
determining a current host vehicle stopping distance, based on the current braking capability of the host vehicle, the current acceleration capability of the host vehicle, and the current longitudinal speed of the host vehicle, the current braking capability of the host vehicle comprising a minimum braking rate that is less than a maximum braking rate of the host vehicle, and the current braking capability of the host vehicle limited by at least one condition relating to deceleration of the host vehicle;
obtaining a current braking capability of the target vehicle and a current longitudinal speed of the target vehicle, the current braking capability of the target vehicle based on a maximum defined braking rate of the target vehicle;
determining a current target vehicle braking distance, based on the current longitudinal speed of the target vehicle and the current braking capability of the target vehicle; and
causing the host vehicle to implement the planned navigational action when the predicted distance of the planned navigational action is greater than a minimum safe longitudinal distance, the minimum safe longitudinal distance being calculated based on the current host vehicle stopping distance and the current target vehicle braking distance.
20. The apparatus of claim 19 , further comprising:
sensing means for capturing the sensing data.