Vehicle lateral motion control
A lane curvature, a vehicle position offset relative to a lane center line, and a vehicle heading are determined based on image data received from a vehicle camera sensor. An adjusted lane curvature and an adjusted vehicle heading are computed based on a vehicle speed, a vehicle yaw rate and the position offset.
1. A method, comprising:
determining, based on image data received from a vehicle camera sensor, a lane curvature, a vehicle position offset relative to a lane center line, and a vehicle heading;
determining a yaw rate bias and a vehicle heading offset bias, wherein the yaw rate bias measures a difference between a road yaw rate and a vehicle yaw rate, and the vehicle heading offset bias measures a difference between the vehicle heading and an estimated vehicle heading;
computing an adjusted lane curvature and an adjusted vehicle heading based on a vehicle speed, the vehicle yaw rate, the vehicle position offset, the yaw rate bias, and the vehicle heading offset bias; and
controlling vehicle steering based at least in part on the adjusted lane curvature and the adjusted vehicle heading.
2. The method of claim 1 , wherein controlling vehicle steering includes performing vehicle lane centering.
3. The method of claim 1 , wherein the vehicle position offset is a lateral distance of a reference point of the vehicle to a nearest point on the lane center line.
4. The method of claim 1 , wherein the vehicle heading is defined by a vehicle longitudinal axis from a vehicle reference point in a direction of a vehicle movement.
5. The method of claim 1 , further comprising:
determining a vehicle heading offset based on the lane curvature; and
computing an adjusted vehicle heading offset and the adjusted lane curvature based at least in part on the vehicle heading offset.
6. The method of claim 1 , further comprising computing the adjusted lane curvature and the adjusted vehicle heading based on a variance of vehicle heading offset noise and a variance of a vehicle position offset noise.
7. The method of claim 1 , further comprising computing, based on the lane curvature determined based on the received image data, the yaw rate bias, the vehicle speed, and the adjusted lane curvature.
8. A system, comprising a processor and a memory, the memory storing instructions executable by the processor to:
determine, based on image data received from a vehicle camera sensor, a lane curvature, a vehicle position offset relative to a lane center line, and a vehicle heading;
determine a yaw rate bias and a vehicle heading offset bias, wherein the yaw rate bias measures a difference between a road yaw rate and a vehicle yaw rate, and the vehicle heading offset bias measures a difference between the vehicle heading and an estimated vehicle heading;
compute an adjusted lane curvature and an adjusted vehicle heading based on a vehicle speed, the vehicle yaw rate, the vehicle position offset, the yaw rate bias, and the vehicle heading offset bias; and
control vehicle steering based at least in part on the adjusted lane curvature and the adjusted vehicle heading.
9. The system of claim 8 , wherein the instructions to control vehicle steering further include instructions to perform vehicle lane centering.
10. The system of claim 8 , wherein the vehicle position offset is a lateral distance of a reference point of the vehicle to a nearest point on the lane center line.
11. The system of claim 8 , wherein the vehicle heading is defined by a vehicle longitudinal axis from a vehicle reference point in a direction of a vehicle movement.
12. The system of claim 8 , wherein the instructions further include instructions to:
determine a vehicle heading offset based on the lane curvature; and
compute an adjusted vehicle heading offset and the adjusted lane curvature based at least in part on the vehicle heading offset.
13. The system of claim 12 , wherein the instructions further include instructions to compute the adjusted lane curvature and the adjusted vehicle heading based on a variance of vehicle heading offset noise and a variance of a vehicle position offset noise.
14. The system of claim 8 , wherein the instructions further include instructions to compute, based on the lane curvature determined based on the received image data, the yaw rate bias, the vehicle speed, and the adjusted lane curvature.
15. A system, comprising:
means for determining, based on image data received from a vehicle camera sensor, a lane curvature, a vehicle position offset relative to a lane center line, and a vehicle heading;
means for determining a yaw rate bias and a vehicle heading offset bias, wherein the yaw rate bias measures a difference between a road yaw rate and a vehicle yaw rate, and the vehicle heading offset bias measures a difference between the vehicle heading and an estimated vehicle heading;
means for computing an adjusted lane curvature and an adjusted vehicle heading based on a vehicle speed, the vehicle yaw rate, the vehicle position offset, the yaw rate bias, and the vehicle heading offset bias; and
means for controlling vehicle steering based at least in part on the adjusted lane curvature and the adjusted vehicle heading.
16. The system of claim 15 , wherein controlling vehicle steering includes performing vehicle lane centering.
17. The system of claim 15 , further comprising:
means for determining a vehicle heading offset based on the lane curvature; and
means for computing the adjusted vehicle heading offset and the adjusted lane curvature based at least in part on the vehicle heading offset.