Vehicle control system using nonlinear dynamic model states and steering offset estimation

1. A method for autonomously controlling a vehicle, the method comprising:

determining, by a processor, a longitudinal velocity, a longitudinal acceleration, a lateral acceleration, and a yaw rate of the vehicle;

estimating, based on the longitudinal velocity, lateral acceleration, and yaw rate of the vehicle, a change in a lateral velocity over time;

estimating, based on the change in the lateral velocity over time, the yaw rate, a distance between the front axle of the vehicle and a center of gravity of the vehicle, and a distance between the rear axle of the vehicle and the center of gravity of the vehicle, a lateral front velocity of the vehicle and a lateral rear velocity of the vehicle;

calculating, based on the lateral front velocity of the vehicle, the lateral rear velocity of the vehicle, a steering angle measurement, and the longitudinal velocity, a front tire slip angle and a rear tire slip angle;

calculating, based on the front tire slip angle and the rear tire slip angle, a front tire lateral force and a rear tire lateral force;

calculating a lateral acceleration bias of the vehicle based on the calculated front tire lateral force and the calculated rear tire lateral force;

updating, by the processor, a state estimation model for the vehicle using the calculated lateral acceleration bias; and

autonomously controlling, by the processor, the vehicle using the updated state estimation model, wherein the updated state estimation model accounts for the lateral acceleration bias.

2. The method of claim 1 , wherein determining the longitudinal velocity, longitudinal acceleration, lateral acceleration, and yaw rate of the vehicle comprises reading measurements of an inertial measurement unit (“IMU”) and a wheel ticker.

3. The method of claim 2 , wherein measurements of the IMU are updated based on a position of the IMU within the vehicle.

4. The method of claim 1 , wherein calculating the front and rear tire lateral forces comprises determining a front and rear tire cornering stiffness.

5. The method of claim 1 , wherein the calculated lateral acceleration bias is used to determine a steering offset.

6. The method of claim 2 , wherein the IMU is a non-zero distance from the center of gravity of the vehicle.

7. The method of claim 1 , wherein the state estimation model comprises six states.

8. A vehicle control system of a vehicle, the system comprising:

a processor; and

a computer-readable storage medium storing computer-readable instructions which, when executed by the processor, cause the processor to perform:

determining a longitudinal velocity, a longitudinal acceleration, a lateral acceleration, and a yaw rate of the vehicle;

estimating, based on the longitudinal velocity, lateral acceleration, and yaw rate of the vehicle, a change in a lateral velocity over time;

estimating, based on the change in the lateral velocity over time, the yaw rate, a distance between the front axle of the vehicle and a center of gravity of the vehicle, and a distance between the rear axle of the vehicle and the center of gravity of the vehicle, a lateral front velocity of the vehicle and a lateral rear velocity of the vehicle;

calculating, based on the lateral front velocity of the vehicle, the lateral rear velocity of the vehicle, a steering angle measurement, and the longitudinal velocity, a front tire slip angle and a rear tire slip angle;

calculating, based on the front tire slip angle and the rear tire slip angle, a front tire lateral force and a rear tire lateral force;

calculating a lateral acceleration bias of the vehicle based on the calculated front tire lateral force and the calculated rear tire lateral force;

updating a state estimation model for the vehicle using the calculated lateral acceleration bias; and

autonomously controlling the vehicle using the updated state estimation model, wherein the updated state estimation model accounts for the lateral acceleration bias.

9. The system of claim 8 , wherein determining the longitudinal velocity, longitudinal acceleration, lateral acceleration, and yaw rate of the vehicle comprises reading measurements of an inertial measurement unit (“IMU”) and a wheel ticker.

10. The system of claim 9 , wherein measurements of the IMU are updated based on a position of the IMU within the vehicle.

11. The system of claim 8 , wherein calculating the front and rear tire lateral forces comprises determining a front and rear tire cornering stiffness.

12. The system of claim 8 , wherein the calculated lateral acceleration bias is used to determine a steering offset.

13. The system of claim 9 , wherein the IMU is a non-zero distance from the center of gravity of the vehicle.

14. The system of claim 8 , wherein the state estimation model comprises six states.

15. A computer program product comprising:

a non-transitory computer-readable storage medium having computer-readable program code embodied therewith, the computer-readable program code configured, when executed by a processor, to:

determine a longitudinal velocity, a longitudinal acceleration, a lateral acceleration, and a yaw rate of a vehicle;

estimate, based on the longitudinal velocity, lateral acceleration, and yaw rate of the vehicle, a change in a lateral velocity over time;

estimate, based on the change in the lateral velocity over time, the yaw rate, a distance between the front axle of the vehicle and a center of gravity of the vehicle, and a distance between the rear axle of the vehicle and the center of gravity of the vehicle, a lateral front velocity of the vehicle and a lateral rear velocity of the vehicle;

calculate, based on the lateral front velocity of the vehicle, the lateral rear velocity of the vehicle, a steering angle measurement, and the longitudinal velocity, a front tire slip angle and a rear tire slip angle;

calculate, based on the front tire slip angle and the rear tire slip angle, a front tire lateral force and a rear tire lateral force;

calculate a lateral acceleration bias of the vehicle based on the calculated front tire lateral force and the calculated rear tire lateral force;

update a state estimation model for the vehicle using the calculated lateral acceleration bias; and

autonomously control the vehicle using the updated state estimation model, wherein the updated state estimation model accounts for the lateral acceleration bias.

16. The computer program product of claim 15 , wherein determining the longitudinal velocity, longitudinal acceleration, lateral acceleration, and yaw rate of the vehicle comprises reading measurements of an inertial measurement unit (“IMU”) and a wheel ticker.

17. The computer program product of claim 16 , wherein measurements of the IMU are updated based on a position of the IMU within the vehicle.

18. The computer program product of claim 15 , wherein calculating the front and rear tire lateral forces comprises determining a front and rear tire cornering stiffness.

19. The computer program product of claim 15 , wherein the calculated lateral acceleration bias is used to determine a steering offset.

20. The computer program product of claim 16 , wherein the IMU is a non-zero distance from the center of gravity of the vehicle.