SYSTEM AND METHOD FOR CALIBRATING A MOTION ESTIMATION ALGORITHM USING A VEHICLE CAMERA

A method of calibrating a driver assistance system comprises entering a calibration mode for a driver assistance system, determining a first estimated position and heading of the vehicle at a first location, capturing an image from a camera and selecting at least one feature in the image. The method of calibrating also includes moving the vehicle to a second location and heading and determining a second estimated position and heading of the vehicle, capturing a second image from a camera and selecting at least one feature in the second image, where the selected feature in the second image the same feature as the selected feature in the first image. The method also includes calculating new vehicle motion parameter values based on the first estimated position and heading, second estimated position and heading, first recorded at least one feature data, and second recorded at least one feature data.