Vehicle lateral motion management with preview road surface information
Systems and method are provided for controlling a vehicle. In one embodiment, a method includes: receiving a first surface value associated with a first road surface area in an upcoming environment of the vehicle; receiving a second surface value associated with a second road surface area in the upcoming environment of the vehicle; determining a change in surface value based on the first surface value and the second surface value; and in response to the change in surface value being greater than a threshold, adapting at least one of vehicle collision warning messages, vehicle braking control, vehicle steering control, and path planning based on the second surface value.
1. A method of controlling a vehicle, comprising:
receiving a first surface value associated with a first road surface area in an upcoming environment of the vehicle;
receiving a second surface value associated with a second road surface area in the upcoming environment of the vehicle;
determining a change in surface value based on the first surface value and the second surface value;
projecting the second surface value to waypoints of an upcoming path; and
in response to the change in surface value being greater than a threshold, adapting at least one of vehicle collision warning messages, vehicle braking control, vehicle steering control, and path planning based on the second surface mu value, the waypoints and the projected surface values.
2. The method of claim 1 , wherein the adapting of the vehicle collision warning messages comprises adapting a timing of generating the vehicle collision warning messages based on the change in surface value.
3. The method of claim 1 , wherein the adapting of the vehicle braking control comprises adapting a timing of generating a vehicle braking command based on the change in surface value.
4. The method of claim 1 , wherein the adapting of the vehicle steering control comprises adapting a timing of generating a vehicle steering command based on the change in surface value.
5. The method of claim 1 , wherein the adapting of the vehicle braking control comprises adapting a vehicle braking command based on model predictive control that is based on the projected surface values.
6. The method of claim 1 , wherein the adapting of the vehicle steering control comprises adapting a steering control command based on model predictive control that is based on the projected surface values.
7. The method of claim 1 , wherein the adapting of the path planning comprises comparing a path curvature to a maximum path curvature for a surface mu.
8. The method of claim 7 , wherein the adapting of the path planning comprises modifying the path to position the vehicle in a new lane in response to a result of the comparing.
9. The method of claim 7 , further comprising computing an error, and wherein the adaptation of path planning is performed in response to the error being greater than a threshold.
10. A system for controlling a vehicle, comprising:
at least one sensor that senses road surfaces in an environment of the vehicle; and
a control module configured to, by a processor, receive a first surface value associated with a first road surface area in an upcoming environment of the vehicle, receive a second surface value associated with a second road surface area in the upcoming environment of the vehicle; project the second surface value to waypoints of an upcoming path; determine a change in surface value based on the first surface value and the second surface value, and in response to the change in surface value being greater than a threshold, adapt at least one of vehicle collision warning messages, vehicle braking control, vehicle steering control, and path planning based on the second surface value, the waypoints and the projected surface values.
11. The system of claim 10 , wherein the control module adapts the vehicle collision warning messages by adapting a timing of generating the vehicle collision warning messages based on the change in surface value.
12. The system of claim 10 , wherein the control module adapts the vehicle braking control by adapting a timing of generating a vehicle braking command based on the change in surface value.
13. The system of claim 10 , wherein the control module adapts the vehicle steering control by adapting a timing of generating a vehicle steering command based on the change in surface value.
14. The system of claim 10 , wherein the control module adapts the vehicle braking control by adapting a vehicle braking command based on model predictive control that is based on the projected surface values.
15. The system of claim 10 , wherein the control module adapts the vehicle steering control by adapting a steering control command based on model predictive control that is based on the projected surface value.
16. The system of claim 10 , wherein the control module adapts the path planning by comparing a path curvature to a maximum path curvature for a surface mu.
17. The system of claim 16 , wherein the control module adapts the path planning by modifying the path to position the vehicle in a new lane in response to a result of the comparing.
18. The system of claim 16 , wherein the control module is further configured to compute an error, and adapt the path planning in response to the error being greater than a threshold.