Steer control logic for emergency handling of autonomous vehicles

1. A method of steer control for a vehicle, comprising:

detecting, by a processor using a sensor, a first lateral velocity of the vehicle at a first point of a vehicle body, a second lateral velocity of the vehicle at a second point of the vehicle body, a longitudinal velocity of the vehicle, and a current steer angle of the vehicle;

calculating, by the processor, a yaw rate and a third lateral velocity at a reference point of the vehicle based on the first lateral velocity and the second lateral velocity, wherein the second lateral velocity is directly measured, or calculated based on the first lateral velocity and the yaw rate;

calculating, by the processor, the third lateral velocity at the reference point, a side slip angle and a yaw center location based on the yaw rate and the lateral velocity of the first point or based on the lateral velocities of the first and second points;

calculating, by the processor, a side slip angle change based on the side slip angle and calculating, by the processor, a side slip angle rate portion of the third lateral velocity based on the side slip angle change and the yaw center location or a distance from the reference point to a yaw center;

calculating, by the processor, a track angle rate portion of the third lateral velocity by subtracting the side slip angle rate portion of the third lateral velocity from the third lateral velocity;

calculating, by the processor, a track angle by calculating an angle between the track angle rate portion of the third lateral velocity and the longitudinal velocity;

calculating, by the processor, a target steer angle of the vehicle based on the track angle and a steer ratio of a steering wheel to a front road wheel to align the front road wheel parallel to a track angle velocity vector; and

adjusting, by the processor, the current steer angle of the vehicle based on the target steer angle.

2. The method of claim 1 , wherein the first point of the body of the vehicle is a first point along a centerline of the vehicle aligned with a front axle of the vehicle, and the second point of the body of the vehicle is a second point along the centerline of the vehicle aligned with a rear axle of the vehicle.

3. The method of claim 1 , wherein a first dual axis optical sensor is mounted proximate to a front axle of the vehicle, and a second dual axis optical sensor is mounted proximate to a rear axle of the vehicle.

4. The method of claim 1 , wherein the reference point is a center of gravity of the vehicle.

5. The method of claim 1 , further comprising:

calculating, by the processor, that the side slip angle rate is equal to zero; and

operating, by the processor, a brake system of the vehicle to decelerate the vehicle in response to determining that the side slip angle rate is equal to zero.

6. A system for steering control of a vehicle, comprising:

a processor;

a first lateral velocity information of a first point of a body of the vehicle; and

a second lateral velocity information of a second point of the body of the vehicle or yaw rate information;

wherein the processor is configured to:

receive a first lateral velocity of the vehicle at a first point of a vehicle body, a second lateral velocity of the vehicle at a second point of the vehicle body, a longitudinal velocity of the vehicle from a longitudinal velocity sensor, and a current steer angle of the vehicle from a current steer angle sensor;

calculate a yaw rate based on the first lateral velocity and the second lateral velocity or measure the yaw rate by a yaw rate sensor;

calculate the third lateral velocity at the reference point, a side slip angle and a yaw center location based on the yaw rate and the lateral velocity of the first point or based on the lateral velocities of first and second points;

calculate a side slip angle change based on the side slip angle and calculating, by the processor, a side slip angle rate portion of the third lateral velocity based on the side slip angle change and the yaw center location or based on the distance from the reference point to a yaw center;

calculate a track angle rate portion of the third lateral velocity by subtracting the side slip angle rate portion of the third lateral velocity from the third lateral velocity;

calculate a track angle by calculating an angle between the track angle rate portion of the third lateral velocity and the longitudinal velocity;

calculate a target steer angle based on the track angle; and

adjust the current steer angle of the vehicle based on the target steer angle.

7. The system of claim 6 , wherein the first point of the body of the vehicle is a first point along a centerline of the vehicle, and the second point of the body of the vehicle is a second point along the centerline of the vehicle.

8. The system of claim 6 , wherein a first dual axis optical sensor is mounted proximate to a front axle of the vehicle, and a second dual axis optical sensor is mounted proximate to a rear axle of the vehicle.

9. The system of claim 6 , wherein the reference point is a center of gravity of the vehicle.

10. The system of claim 6 , wherein the processor is further configured to:

determine that the side slip angle rate is equal to zero; and

operate a brake system of the vehicle to control yaw stability of the vehicle in response to determining that the side slip angle rate is equal to zero.