CPC B62D 6/04 (2013.01) [B62D 5/0463 (2013.01); G06T 7/60 (2013.01); G06T 2207/30256 (2013.01)] | 17 Claims |
1. A road slope compensation system using camera information, the system comprising:
a camera module configured to capture and obtain a front image of a vehicle;
a vehicle sensor device configured to sense and obtain state information of the vehicle;
a compensation calculation device configured to calculate a compensation yaw rate, using a sensor signal delivered from the vehicle sensor device and a heading error by the front image delivered from the camera module, when the vehicle is driving on a road having a threshold road slope; and
a correction controller configured to:
calculate a final yaw rate by applying a compensation yaw rate delivered from the compensation calculation device, to a target yaw rate calculated by using the sensor signal, a line curvature yaw rate by the front image, and a current heading; and
calculate a final steering torque by the final yaw rate to control a steering device,
wherein the correction controller controls a steering device after calculating the final steering torque by using the compensation yaw rate to compensate for a performance difference between left tracking and right tracking of the vehicle, which is caused by the threshold road slope.
|