Vehicle lateral compensation for path deviation due to environmental forces
A number of variations are disclosed including a system and method including modifying motion controller actuator commands in real-time based on calculated offset induced when a vehicle exceeds acceleration and rotational limits of a vehicle when experiencing crosswind or other environmental forces.
1. A computer readable medium comprising:
non-transitory memory operable for machine instructions that are to be executed by a computer, the machine instructions when executed by the computer implement the following functions comprising:
determining a first set of actuation commands;
determining a first set of vehicle acceleration and rotational limits corresponding to the first set of actuation commands;
receiving or measuring forces via at least one of an inertial measurement unit, and a vehicle corner height measured by a vehicle wheel height sensor;
determining measured motion data including orientation of external forces local to a vehicle based on vehicle acceleration, rotation, and geomagnetic from the inertial measurement unit, and relative vehicle corner height from the vehicle wheel height sensor;
determining physical model deviations based on the measured motion data;
determining if measured vehicles dynamics at least one of reach or exceed the first set of vehicle acceleration and rotational limits;
calculating at least one vehicle acceleration limit offset or at least one rotational limit offset based at least on the physical model deviations; and
determining a first set of actuation adjustments based off the at least one vehicle acceleration limit offset or at least one rotational limit offset.
2. A computer readable medium as in claim 1 , further comprising modifying the first set of actuation commands with the first set of actuation adjustments to generate a second set of actuation commands.
3. A computer readable medium as in claim 2 , further comprising modifying at least one of vehicle propulsion, steering, or braking actuator commands based on the second set of actuation commands.
4. A computer readable medium as in claim 3 , further comprising actuating at least one of a vehicle propulsion, steering, or braking actuator based on the second set of actuation commands.
5. A computer readable medium comprising:
non-transitory memory operable for machine instructions that are to be executed by a computer, the machine instructions when executed by the computer implement the following functions comprising:
determining at least one of a vehicle propulsion command, a steering actuator command, or a braking actuator command to achieve a desired path of travel;
communicating the at least one of vehicle propulsion, steering, or braking actuator commands to a predictive model;
predictively modeling vehicle behavior based on the at least one of vehicle propulsion, steering, or braking actuator commands;
receiving or measuring forces via at least one of an inertial measurement unit, and a vehicle corner height measured by a vehicle wheel height sensor;
determining measured motion data including orientation of external forces local to a vehicle based on vehicle acceleration, rotation, and geomagnetic from the inertial measurement unit, and relative vehicle corner height from the vehicle wheel height sensor;
determining physical model deviations based on the measured motion data;
comparing dynamic vehicle data to at least one modeled vehicle behavior comprising at least one acceleration limit or rotational limit; and
adjusting the vehicle propulsion commands, steering commands, or braking actuator commands to stay within the modeled vehicle behavior comprising at least one acceleration limit or rotational limit based at least on the physical model deviations.
6. A computer readable medium as in claim 5 , further comprising communicating at least one of adjusted vehicle propulsion, steering, or braking actuator commands to a trajectory planner.
7. A computer readable medium as in claim 5 , further comprising communicating at least one of adjusted vehicle propulsion, steering, or braking actuator capacity consumed to achieve adjusted vehicle propulsion, steering, or braking actuator commands to a motion planner.
8. A computer readable medium as in claim 5 , wherein: adjusting the vehicle propulsion commands, steering commands, or braking actuator commands to stay within the modeled vehicle behavior comprising at least one acceleration limit or rotational limit occurs independently from a forward-looking sensor system identifying road limits.
9. A computer readable medium as in claim 8 , wherein: adjusting the vehicle propulsion commands, steering commands, or braking actuator commands to stay within the modeled vehicle behavior comprising at least one acceleration limit or rotational limit occurs prior to identifying road limits via a forward-looking sensor system.
10. A computer readable medium comprising instructions executable by an electronic processor to carry out actions, comprising:
determining a first set of actuation commands;
determining a first set of vehicle acceleration and rotational limits corresponding to the first set of actuation commands;
receiving or measuring forces via at least one of an inertial measurement unit, and a vehicle corner height measured by a vehicle wheel height sensor;
determining measured motion data including orientation of external forces local to a vehicle based on vehicle acceleration, rotation, and geomagnetic from the inertial measurement unit, and relative vehicle corner height from the height sensor;
determining physical model deviations based on the measured motion data;
determining if measured vehicles dynamics at least one of reach or exceed the first set of vehicle acceleration and rotational limits;
calculating at least one vehicle acceleration limit offset or at least one rotational limit offset based at least on the physical model deviations; and
determining a first set of actuation adjustments based off the at least one vehicle acceleration limit offset or at least one rotational limit offset.
11. A computer readable medium as in claim 10 , further comprising modifying the first set of actuation commands with the first set of actuation adjustments to generate a second set of actuation commands.
12. A computer readable medium as in claim 11 , further comprising modifying at least one of vehicle propulsion, steering, or braking actuator commands based on the second set of actuation commands.
13. A computer readable medium as in claim 12 , further comprising actuating at least one of a vehicle propulsion, steering, or braking actuator based on the second set of actuation commands.
14. A computer readable medium as in claim 10 , wherein: determining a first set of actuation adjustments based off the at least one vehicle acceleration limit offset or at least one rotational limit offset occurs independently from a forward-looking sensor system identifying road limits.
15. A computer readable medium as in claim 14 , wherein: determining a first set of actuation adjustments based off the at least one vehicle acceleration limit offset or at least one rotational limit offset occurs prior to identifying road limits via a forward-looking sensor system.