Method of determining the roll angle of a vehicle mounted camera
A method of determining the roll angle of a camera mounted on a host vehicle includes: a) defining Cartesian axes in the real world and corresponding axes in the camera imager; b) from an image taken from the camera, determining the co-ordinates of the two points (P1, P2) of the real world, in the imager of the camera ((x I,1, y I,1), (x I,2, y I,2)); c) determining the difference (D) in the coordinates of the points in a horizontal World plane in one axis (Xw,1−Xw,2), using corresponding co-ordinate system as in step b); and d) determining the roll angle ρ of a camera located on a host vehicle from the following formula ρ=[ D/h −( c 2 /a 2 −c 1 /a 1 )]/[( a 2 d 2 −b 2 c 2 )/ a 2 2 −( a 1 d 1 −b 1 c 1 )/ a 1 2 ], where a 1 and a 2 are found from the following, where i=1,2 represents the two points (P1, P2): a i =sin θ* f +cos θ* y I,i ; b i =−cos θ* x I,i c i =−cos η cos θ* f +sin η* x I,i +cos η sin θ* y I,I d i =−cos η sin θ* x I,i +sin η* y I,i where for θ is the known value of fixed tilt angle, η is the known value of fixed pan angle and h is the known fixed camera height h; and x I,i , y I,i are the respective co-ordinates of two of the points in the imager.
1. A method of determining a roll angle of a camera mounted on a host vehicle comprising:
a) defining Cartesian axes in a real world coordinate system and corresponding axes in a corresponding coordinate system of a camera imager;
b) from an image taken from the camera, determining corresponding coordinates of two points (P1, P2) of the real world coordinate system, in the camera imager ((x I,1, y I,1), (x I,,2, y I,2));
c) determining a difference (D) in the coordinates of the two points (P1, P2) in a horizontal World plane in one axis of the real world coordinate system (Xw,1−Xw,2), using the corresponding coordinate system as in step b); and
d) determining a roll angle ρ of a camera located on a host vehicle from a following formula:
ρ=[ D/h −( c 2 /a 2 −c 1 /a 1 )]/[( a 2 d 2 −b 2 c 2 )/ a 2 2 −( a 1 d 1 −b 1 c 1 )/ a 1 2 ],
where a 1 and a 2 are found from the following, where i=1,2 represents the two points (P1,P2):
a i =sin θ* f +cos θ* y I,i ,
bi =−cos θ* xI,I,
ci =−cos η cos θ* f +sin η* xI,i +cos η sin θ* yI,I , and
di =−cos η sin θ* xI,i +sin η* yI,I,
where for θ is a known value of fixed tilt angle, η is the known value of fixed pan angle and h is a known fixed camera height h, and
x I,i , y I,i are the respective coordinates of the two points (P1,P2) in the imager.
2. A method as claimed in claim 1 wherein in step a) axes are defined as a X-axis which is in a direction of travel or an orientation of the vehicle forwards and the Y-axis is perpendicular to the X-axis.
3. A method as claimed in claim 1 where step c) is performed using data from a known coordinate position of the two points (P1,P2) in the real World.
4. A method as claimed in claim 1 where the two points (P1,P2) are end points of a lane marking, the lane marking being of pre-determined length (L), and determining a value of the difference (D) from a lane marking length and a known orientation of the camera or a vehicle angle relative to the lane marking.