CPC B60W 60/0016 (2020.02) [B60W 30/09 (2013.01); B60W 30/0953 (2013.01); B60W 30/0956 (2013.01); B60W 30/181 (2013.01); B60W 30/18163 (2013.01); B60W 40/02 (2013.01); B60W 40/105 (2013.01); B60W 40/107 (2013.01); B60W 60/0015 (2020.02); G05D 1/0214 (2013.01); G05D 1/0231 (2013.01); G05D 1/0246 (2013.01); G06T 7/20 (2013.01); G06T 7/70 (2017.01); G06V 20/58 (2022.01); G06V 20/584 (2022.01); G06V 40/10 (2022.01); B60W 2420/42 (2013.01); B60W 2420/52 (2013.01); B60W 2510/18 (2013.01); B60W 2520/105 (2013.01); B60W 2520/12 (2013.01); B60W 2520/125 (2013.01); B60W 2520/14 (2013.01); B60W 2530/201 (2020.02); B60W 2552/45 (2020.02); B60W 2554/4029 (2020.02); B60W 2554/4041 (2020.02); B60W 2554/4042 (2020.02); B60W 2554/4043 (2020.02); B60W 2554/4044 (2020.02); B60W 2554/80 (2020.02); B60W 2554/801 (2020.02); B60W 2555/60 (2020.02); B60W 2720/10 (2013.01); G05D 2201/0213 (2013.01); G06T 2207/30196 (2013.01); G06T 2207/30261 (2013.01); G06V 2201/07 (2022.01)] | 30 Claims |
1. A method for navigating a host vehicle, the method comprising: receiving, from an image capture device, at least one image representative of an environment of the host vehicle;
determining, based on at least one driving policy, a planned navigational action for accomplishing a navigational goal of the host vehicle;
analyzing the at least one image to identify a target vehicle in the environment of the host vehicle;
determining a next-state lateral distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken;
determining a maximum yaw rate capability of the host vehicle, a maximum change in turn radius capability of the host vehicle, and a current lateral speed of the host vehicle;
determining a lateral braking distance for the host vehicle based on the maximum yaw rate capability of the host vehicle, the maximum change in turn radius capability of the host vehicle, and the current lateral speed of the host vehicle;
determining a current lateral speed of the target vehicle, a target vehicle maximum yaw rate capability, and a target vehicle maximum change in turn radius capability;
determining a lateral braking distance for the target vehicle based on the current lateral speed of the target vehicle, the target vehicle maximum yaw rate capability, and the target vehicle maximum change in turn radius capability;
determining that the next-state lateral distance is greater than a sum of the lateral braking distance for the host vehicle and the lateral braking distance of the target vehicle; and
implementing the planned navigational action when the determined next-state lateral distance is greater than the sum of the lateral braking distance for the host vehicle and the lateral braking distance of the target vehicle.
|