Vehicle vision system with calibration algorithm

Information

  • Patent Grant
  • 10235775
  • Patent Number
    10,235,775
  • Date Filed
    Wednesday, March 7, 2018
    6 years ago
  • Date Issued
    Tuesday, March 19, 2019
    5 years ago
Abstract
A method for calibrating a camera of a vehicular vision system includes providing a camera and an image processor at the vehicle. A monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere is determined via processing of image data captured by the camera. Responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, extrinsic parameters of the camera and intrinsic parameters of the camera are estimated. The system performs at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters. Responsive to processing by the image processor of image data captured by the camera, the camera is calibrated at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern.
Description
FIELD OF THE INVENTION

The present invention relates generally to a vehicle vision system for a vehicle and, more particularly, to a vehicle vision system that utilizes one or more cameras at a vehicle.


BACKGROUND OF THE INVENTION

Use of imaging sensors in vehicle imaging systems is common and known. Examples of such known systems are described in U.S. Pat. Nos. 5,670,935 and/or 5,550,677, which are hereby incorporated herein by reference in their entireties.


SUMMARY OF THE INVENTION

The present invention provides a vision system or imaging system for a vehicle that utilizes one or more cameras (preferably one or more CMOS cameras) to capture image data representative of images exterior of the vehicle, and provides an enhanced calibration of the camera or cameras, as discussed below.


These and other objects, advantages, purposes and features of the present invention will become apparent upon review of the following specification in conjunction with the drawings.





BRIEF DESCRIPTION OF THE DRAWINGS


FIG. 1 is a plan view of a vehicle with a vision system that incorporates cameras in accordance with the present invention;



FIG. 2 shows the mapping of a scene point x onto the sensor plane to a point u″;



FIG. 3 shows a geometrical interpretation of fisheye lens projection, with mapping of the vector q onto the sensor plane π through the projection function g(ρ);



FIG. 4A shows a centered and aligned sensor plane with respect to the image plane;



FIG. 4B shows where an optical center and an image center are not aligned, also the tilt of the imager is formulated by Affine transformation;



FIGS. 5 and 6 show a design of distribution of 3D calibration in space in the form of a semi-sphere in accordance with the present invention; and



FIG. 7 shows a sectional view of a camera and lens of the vision system of the present invention.





DESCRIPTION OF THE PREFERRED EMBODIMENTS

A vehicle vision system and/or driver assist system and/or object detection system and/or alert system operates to capture images exterior of the vehicle and may process the captured image data to display images and to detect objects at or near the vehicle and in the predicted path of the vehicle, such as to assist a driver of the vehicle in maneuvering the vehicle in a rearward direction. The vision system includes an image processor or image processing system that is operable to receive image data from one or more cameras and provide an output to a display device for displaying images representative of the captured image data. Optionally, the vision system may provide a top down or bird's eye or surround view display and may provide a displayed image that is representative of the subject vehicle, and optionally with the displayed image being customized to at least partially correspond to the actual subject vehicle.


Referring now to the drawings and the illustrative embodiments depicted therein, a vehicle 10 includes an imaging system or vision system 12 that includes at least one exterior facing imaging sensor or camera, such as a rearward facing imaging sensor or camera 14a (and the system may optionally include multiple exterior facing imaging sensors or cameras, such as a forwardly facing camera 14b at the front (or at the windshield) of the vehicle, and a sidewardly/rearwardly facing camera 14c, 14d at respective sides of the vehicle), which captures images exterior of the vehicle, with the camera having a lens for focusing images at or onto an imaging array or imaging plane or imager of the camera (FIG. 1). The vision system 12 includes a control or electronic control unit (ECU) or processor 18 that is operable to process image data captured by the cameras and may provide displayed images at a display device 16 for viewing by the driver of the vehicle (although shown in FIG. 1 as being part of or incorporated in or at an interior rearview mirror assembly 20 of the vehicle, the control and/or the display device may be disposed elsewhere at or in the vehicle). The data transfer or signal communication from the camera to the ECU may comprise any suitable data or communication link, such as a vehicle network bus or the like of the equipped vehicle.


Intrinsic camera calibration (IC) is an integral and essential part of camera based platforms, such as a platform project that uses a fisheye lens camera to facilitate a wide field of view of about 205 degrees. Among several available open-source libraries for IC, Davide Scaramuzza's omnidirectional camera calibration (OCamCalib) library written in Matlab programming language is one of the few implementations which are taking care of lenses with large radial distortion such as fisheye lens cameras (see Scaramuzza, “Omnidirectional Vision: From Calibration to Robot Motion Estimation”, Dissertation submitted to Eth Zurich for the degree of Doctor of Science, Diss. Eth No. 17635, which is hereby incorporated herein by reference in its entirety). The OCamCalib model describes the camera imaging process in terms of a Taylor polynomial expansion, coefficients of which are the intrinsic camera calibration parameters.


The system uses multiple-view coplanar points (such as in chessboard-like pattern) for calibration of intrinsic parameters of a camera. The system of the present invention extends the OCamCalib method for calibrating a camera using monoview non-coplanar (3-dimensional) points distributed on a sphere or semi-sphere.


Acronyms




  • IC Intrinsic Camera Calibration

  • FOV Field of View

  • OCamCalib Omnidirectional Camera Calibration

  • 1D One dimensional

  • 2D Two dimensional

  • 3D Three dimensional

  • SSRE Sum of Squared Re-projection Errors

  • SVD Singular Value Decomposition


    Theoretical Background of the Omnidirectional Camera Calibration:



A lens which covers a hemisphere field of about 180 degrees is usually called a fisheye lens. The present invention presents intrinsic parameter calibration of fisheye cameras is based on OCamCalib model. The OCamCalib model is based on a unified model for central panoramic systems. This model is defined only for the central camera systems.


Geometry of Omnidirectional Cameras


The below summarizes the geometrical considerations of omnidirectional cameras, such as described in Diss. Eth No. 17635. The fisheye lens camera is the special case of an omnidirectional camera. So, the general formulation for the omnidirectional cameras will also satisfy formulations for the fisheye lens cameras.


The Omnidirectional Camera Model


The projection equation for a standard camera with normal FOV can be written as:

λx=P·X  (1)

where X=[X, Y, Z] are the world-coordinates of the scene point, x=[x, y, 1] are the normalized image coordinates of that scene point, and λ is an arbitrary depth scale factor. Projection matrix P∈custom character3×4 relates the camera reference frame and the world reference frame with P=Á[R|T], where R∈SO(3) is the rotation matrix and T∈custom character3 is the translation vector. For an ideal perspective camera, the camera intrinsic matrix Á is identity matrix. This projection equation is invalid for the omnidirectional camera with a FOV larger than about 180 degrees. The projection equation for the omnidirectional rather follows a spherical model, written as:

λq=P·X,λ>0  (2)

Here, q=[x, y, z] is the unit vector on projection sphere. As shown in FIG. 2, a scene point X is shown as observed through an omnidirectional camera (such as, for example, a fisheye camera or hyperbolic mirror).


Following the spherical model of Eq. (2), a vector p″ in the same direction as q always exists, which is mapped on the sensor plane as u″, collinear with x″. This mapping can be formalized as follows:










p


=

[





h


(



u




)




(

u


)







g


(



u




)





]





(
3
)








Here, g and h are the functions depending upon the type of lens (e.g. equidistant, equisolid etc.) for the fisheye lens cameras and type of mirror (e.g. parabolic, hyperbolic, elliptical) for the mirror-based camera systems. For the fisheye case, the function h is always equal to 1, i.e. the vector p″ is mapped orthographically to the point u″ on the sensor plane. Another geometrical interpretation for this mapping is shown in FIG. 3.


Projection onto Camera Plane


When considering an imaging process in a general central camera model, two distinct reference systems are identified: the camera image plane and the sensor plane. The sensor plane can be considered as a hypothetical plane orthogonal to the (fisheye) lens axis and with its origin at the camera optical center. In realistic scenarios, there exists an angular misalignment between the camera image plane and the sensor plane. This misalignment is taken care by adding a three degree-of-freedom rotation Rc∈SO(3) to the camera model. Furthermore, non-rectangularity of the grid where actually the pixels are located in digitization process is also required to be considered, which is corrected by introduction of an intrinsic parameter matrix Kccustom character3×3. Combining both, a homography transformation from the sensor plane to the camera plane is obtained by Hc=KcRc.


Assuming a very small misalignment, this homography transformation Hc is approximated well by an Affine transformation that transforms the circular field of view into an elliptical one in the digital image, as shown in FIGS. 4A and 4B.


The approximated homography transformation in form of an Affine transformation is written as:

u″=Au′+t  (4)

Placing the Eq. (4) in the Eq. (3), the complete image mapping model is written as:










p


=


[





h


(



u




)




(

u


)







g


(



u




)





]

=

[





h


(




Au


+
t



)




(


Au


+
t

)







g


(




Au


+
t



)





]






(
5
)








By combining Equations (2) and (5), the complete projection equation for an omnidirectional camera is written as:










λ






p



=


λ


[





h


(




Au


+
t



)




(


Au


+
t

)







g


(




Au


+
t



)





]


=

P
·
X






(
6
)








It should be noted again that for fisheye lens cameras, the function h=1, which further simplifies the formulations.


The Taylor Model


Instead of using two distinct functions h and g, it is sufficient to use only one function g/h. By substituting h=1 in the Eq. (6), g has to be determined which satisfies the following projection equation:










λ






p



=


λ


[




u







g


(



u




)





]


=

P
·
X






(
7
)








The following polynomial of degree N is proposed g in:

g(∥u″∥)=a0+a1∥u″∥+a2∥u″∥2+ . . . +aN∥u″∥N  (8)

Where the coefficients a0, a1, . . . , aN and N are the calibration parameters to be estimated. The polynomial g always satisfies the following condition:













d





g


d





ρ





ρ
=
0


=
0




(
9
)








with ρ=u″. As a result of this simplification, the condition a1=0 can be imposed, and the Eq. (8) can be written as follows:

g(∥u″∥)=a0+a2∥u″∥2+ . . . +aN∥u″∥N  (10)

Now, the number of calibration parameter to be estimated is reduced to N from N+1. Placing Eq. (10) in the Eq. (5), we obtain the image formation model as:











p


=


[





h


(



u




)




(

u


)







g


(



u




)





]

=

[




u








a
0

+


a
2






u




2


+

+


a
N






u




N






]










with






u



=


Au


+
t






(
11
)








Using Equations (7) and (11), the final projection equation for central omnidirectional camera following the Taylor model is written as:











λ






p



=


λ


[




u








a
0

+


a
2






u




2


+

+


a
N






u




N






]


=

P
·
X










with






u



=


Au


+
t






(
12
)








In order to calibrate a fisheye lens camera, parameters A, t, a0, a2, . . . , and aN need to be estimated which satisfy the Equation (12). Here, A and t are the Affine parameters, and a0, a2, . . . , and aN are the coefficients which describe the shape of imaging polynomial function g.


Camera Calibration Using the Taylor Model and 2D Calibration Pattern


Scaramuzza proposed to estimate the calibration parameters in two stages. First stage estimates the Affine parameters A and t, and the second stages deals with the estimation of coefficients a0, a2, . . . , and aN. The estimation of Affine parameters A and t is based on an iterative procedure. This procedure is initialized assuming that the camera plane and sensor plane coincides, thus the stretch matrix A is set to be an identity matrix I and the translation vector t=0. Correction in A is done later using a nonlinear refinement, and in t by an iterative search algorithm. With the assumptions A=I and t=0, we have u″=u′. Thus the Equation (12) can be written as follows:










λ






p



=


λ


[




u







v








a
0

+


a
2



ρ







2



+

+


a
N



ρ







N







]


=

P
·
X






(
13
)








Where ρ′=∥u″∥ and (u′, v′) are the pixel coordinates of the image point u′. The calibration procedure uses a planar pattern image Ii of known geometry (e.g. a chessboard-like pattern) shown to the camera at several unknown ith positions and orientations. These unknown positions and orientations are related to the coordinate system of the sensor by a rotation matrix R∈SO(3) and a translation vector T∈custom character3. R and T are the extrinsic parameters. As the calibration pattern image used is planar, the z-coordinate in the 3D coordinates of the jth points of calibration pattern image Ii (i.e., Mji=[Xji, Yji, Zji]), can be set to zero, that is Zji=0. Assuming corresponding pixel coordinates of jth point of calibration pattern image Ii to be mji=[uji, vji], the Eq. (13) can be rewritten as follows:











λ
j
i

·

p
j
i


=



λ
j
i

·

[




u
j
i






v
j
i







a
0

+


a
2



ρ
j

i
2



+

+


a
N



ρ
j

i
N







]


=



P
i

·

X
j
i


=



[




r
1
i




r
2
i




r
3
i




T
i




]

·

[




X
j
i






Y
j
i





0




1



]


=


[




r
1
i




r
2
i




T
i




]

·

[




X
j
i






Y
j
i





1



]









(
14
)








Where r1i, r2i, and r3i are the column vectors of Ri, and recall P=[R|T] from the discussions above.


Extrinsic Parameter Estimation


Dependence of the depth scale λji is eliminated by vector product of Eq. (14) on both sides by pji and we obtain:












λ
j
i

·

p
j
i


×

p
j
i


=



p
j
i

×


[




r
1
i




r
2
i




T
i




]

·

[




X
j
i






Y
j
i





1



]



=
0





(
15
)







=
Δ





[




u
j
i






v
j
i







a
0

+


a
2



ρ
j

i
2



+

+


a
n



ρ
j

i
N







]

×


[




r
1
i




r
2
i




T
i




]

·

[




X
j
i






Y
j
i





1



]



=
0














Solving the Eq. (15), following three homogeneous equations are obtained for each jth point pji in the ith position and orientation of the planar pattern image Ii:

vji(r31iXji+r32iYji+t3i)−(a0+aji2+ . . . +ajiN)(r21iXji+r22iYji+t2i)=0  (16)
(a0+a2ρji2+ . . . +aNρjiN)(r11iXji+r12iYji+t1i)−uji(r31iXji+r32iYji+t3i)=0  (17)
uji(r21iXji+r22iYji+t2i)−vji(r11iXji+r12iYji+t1i)=0  (18)

The Eq. (18) is a linear equation in unknowns r11i, r12i, r21i, r22i, t1i and t2i, which can be written in the vector form for L points of the ith poses of calibration pattern as a following system of equations:










M
·
H

=
0




(
19
)





with











M
=

[





-

v
1
i




X
1
i






-

v
1
i




Y
1
i






u
1
i



X
1
i






u
1
i



Y
1
i





-

v
1
i





u
1
i



























-

v
L
i




X
L
i






-

v
L
i




Y
L
i






u
L
i



X
L
i






u
L
i



Y
L
i





-

v
L
i





u
L
i




]


,
and




(
20
)






H
=

[




r
11
i






r
12
i






r
21
i






r
22
i






t
1
i






t
2
i




]














The solution of the Eq. (19) can be obtained by:

min∥M·H∥2=0, subject to ∥H∥2=1  (21)

This can be accomplished by using singular value decomposition (SVD) method. Because of the orthonormality, parameters r31i and r32i the ith pose of calibration pattern can also be estimated uniquely. The remaining unknown parameter t3i is estimated in the next step along with the intrinsic parameters.


Intrinsic Parameter Estimation


Using the estimated values of r11i, r12i, r21i, r22i, r31i, r32i, t1i and t2i from Equations (16) and (17) for each ith pose, the camera intrinsic parameters a0, a2, . . . , and aN are estimated in the next step. The unknown parameter t3i is also estimated for each pose of the camera calibration pattern image. Following system of equation can be written, using Equations (16) and (17), for all L points in all K poses of the calibration pattern:











[




A
j
1





A
j
1



ρ
j

1
2










A
j
1



ρ
j

1
N






-

v
j
1




0





0





C
j
1





C
j
1



ρ
j

1
2










C
j
1



ρ
j

1
N






-

u
j
1




0





0































A
j
K





A
j
K



ρ
j

K
2










A
j
K



ρ
j

K
N





0


0






-

v
j
K







C
j
K





C
j
K



ρ
j

K
2










C
j
K



ρ
j

K
N






0

 



0






-

u
j
K





]

·

[




a
0






a
2











a
N






t
3
1






t
3
2











t
3
K




]


=

[




B
j
1






D
j
1











B
j
K






D
j
K




]





(
22
)










Where


















A
j
i

=



r
21
i



X
j
i


+


r
22
i



Y
j
i


+

t
2
i



,










B
j
i

=


v
j
i



(



r
31
i



X
j
i


+


r
32
i



Y
j
i



)



,










C
j
i

=



r
11
i



X
j
i


+


r
12
i



Y
j
i


+

t
1
i



,










D
j
i

=



u
j
i



(



r
31
i



X
j
i


+


r
32
i



Y
j
i



)


.







(
23
)








The intrinsic parameters a0, a2, . . . , and aN can be estimated by a linear least square solution of above equation solved using pseudo inverse matrix method.


Linear Refinement of Intrinsic and Extrinsic Parameters


Using a further linear minimization, first refinement is performed over the estimated extrinsic and intrinsic parameters, which were obtained above. This linear refinement is carried out in following two steps:

    • 1. The intrinsic parameters a0, a2, . . . , and aN estimated above are used to solve the Equations (16), (17), and (18) altogether in r11, r12, r21, r22, r31, r32, t1, t2 and t3 using singular value decomposition as a linear homogeneous system. It can be carried out only up to a certain scale factor, which is determined uniquely by exploiting orthonormality between r1 and r2.
    • 2. The parameters r11, r12, r21, r22, r31, r32, t1, t2 and t3 estimated in above step are now used to refine the intrinsic parameters a0, a2, . . . , and aN, again by solving a linear system of equations obtained in above sections using pseudo inverse-matrix method.


      Center of Distortion Detection


The position of center of camera is detected using an iterative search algorithm by minimizing the sum of squared re-projection errors (SSRE). To initiate, a fixed number of potential camera center locations, uniformly distributed over the image, are selected. Calibration is using steps in the above sections is performed for each potential camera center location. Point with minimum SSRE is considered as the potential camera center. These steps are repeated for the points in the neighborhood of selected potential camera center until convergence is achieved.


Nonlinear Refinement of Intrinsic and Extrinsic Parameters


Linearly refined extrinsic and intrinsic parameters obtained above are further refined nonlinearly through maximum likelihood inference as mentioned in the OCamCalib model, assuming that the image points are corrupted by independent and identically distributed noise. In order to obtain a maximum likelihood estimate for refinement, the following function is minimized:









E
=




i
=
1

K






j
=
1

L







u
j
i

-


u
^



(


R
i

,

T
i

,
A
,

O
c

,

a
0

,

a
2

,





,

a
N

,

X
j
i


)





2







(
24
)








Here K poses of the calibration pattern are considered, each containing L corner points, and û(Ri, Ti, A, Oc, a0, a2, . . . , aN, Xji) is the re-projection of the jth scene point Xji on ith pattern pose. Ri and Ti are the rotation and translation (position) of the ith pattern pose. So basically, the Equation (24) is carrying out the refinement of calibration parameters by minimizing the re-projection error.


The stretch matrix A as well as the center of distortion Oc is also refined in this step. Refinement in Oc is taking care of t Equation (4). First guess for the stretch matrix A is the identity matrix I, and first guess for the center of distortion Oc is obtained above.


Camera Calibration Using the Taylor Model and 3D Calibration Pattern


The system described above may use a chessboard-like coplanar pattern for calibration. This planar calibration pattern is shown to camera at random positions and orientations. Contrary to a 2D calibration pattern, the below process or system formulates relations for calibrating a camera using points in a 3D calibration pattern, distributed on a (semi-) sphere, coordinates of which are known with great accuracy. Formulations for extrinsic parameters estimation are based on the algorithm presented in (see Tsai, “A versatile Camera Calibration Technique for High-Accuracy 3D Machine Vision Metrology Using Off-the-Shelf TV Cameras and Lenses,” IEEE Vol. RA-3, No. 4, August 1987, which is hereby incorporated herein by reference in its entirety).


Calibration Procedure


First stage estimates the Affine parameters A, and t, and the second stages deals with the estimation of coefficients a0, a2, . . . , and aN. The estimation of Affine parameters A, and t is based on an iterative procedure. This procedure is initialized assuming that the camera plane and sensor plane coincides, thus the stretch matrix A is set to be an identity matrix I and the translation vector t=0. Correction in A is done later using a nonlinear refinement, and in t by an iterative search algorithm. With the assumptions A=1 and t=0, we have u″=u′. Thus the Equation (12) can be written as follows:










λ






p



=


λ


[




u







v








a
0

+


a
2



ρ



2








+

+


a
N



ρ


N







]


=

P
·
X






(
25
)








Where ρ′=∥u′∥ and (u′, v′) are the pixel coordinates of the image point u′. The calibration procedure now uses points in 3D space, coordinates of which are known with great accuracy. The positions of these points are related to the coordinate system of the sensor by a rotation matrix R∈SO(3) and a translation vector T∈custom character3. R and T are the extrinsic parameters. The calibration pattern is not planar, so the z-coordinate in the 3D coordinates of the jth points of calibration pattern (i.e., Mj=[Xj, Yj, Zj]) is not set to zero. Assuming corresponding pixel coordinates of jth point of calibration pattern image I to be mj=[uj, vj], the Equation (25) can be rewritten as follows:











λ
j

·

p
j


=



λ
j

·

[




u
j






v
j







a
0

+


a

2








ρ
j
2


+

+


a
N



ρ
j
N






]


=


P
·

x
j


=


[




r
1




r
2




r
3



T



]

·

[




X
j






Y
j






Z
j





1



]








(
26
)












[




r
1




r
2




r
3



T



]

=

[




r
11




r
12




r
13




t
1






r
21




r
22




r
23




t
2






r
31




r
32




r
33




t
3




]






(
27
)








Where r1, r2, and r3 are the column vectors of Ri, and recall P=[R|T] from the above discussions.


Extrinsic Parameter Estimation


The image center may be assumed to be [uc,vc]. Using this image center coordinate, modified pixel coordinates are computed as [uj′, vj′]=[uj−uc, vj−vc]. For each calibration point Mj=[Xj, Yj, Zj] in 3D corresponding to their 2D image points in modified pixel coordinates, following set of linear equation is formulated:










[





v
j


·

X
j






v
j


·

Y
j






v
j


·

Z
j





v
j






-

u
j



·

X
j






-

u
j



·

Y
j






-

u
j



·

Z
j





]






[





t
2

-
1


·

s
x

·

r
11








t
2

-
1


·

s
x

·

r
12








t
2

-
1


·

s
x

·

r
13








t
2

-
1


·

s
x

·

t
1








t
2

-
1


·

r
21








t
2

-
1


·

r
22








t
2

-
1


·

r
23





]

=

u
j








(
28
)








Here sx is the uncertainty image scale factor. The above system of equation can be solved using pseudo inverse-matrix method for seven unknowns a1=t2−1·sx·r11, a2=t2−1·sx·r12, a3=t2−1·sx·r13, a4=t2−1·sx·r14, a5=t2−1·r21, a6=t2−1·r22 and a7=t2−1·r23. Although Equation (28) will have infinitely many solutions, the pseudo inverse-matrix method will give a solution with norm smaller than the norm of any other solution. Now the value for |t2| is computed using following relation:

|t2|=(a52+a62+a72)−1/2  (29)


In order to determine the sign of t2 a calibration point in the image is picked, whose coordinates (uj, vj), are away from the center of image. Initial sign of t2 is chosen as +1 and following variables are computed:

r11=(r24−1·r11t2, r12=(r24−1·r12t2  (30)

IF u and X have the same sign, as well as v and Y have the same sign, then sign of t2+1, ELSE sign of t2=−1. The value for sx is computed using following relation:

sx=(a12+a22+a32)−1/2·|t2|  (31)

Knowing the values of sx (which should be equal to 1 in ideal case) and t2, the values of r11, r12, r13, t1, r21, r22, and r23 can be estimated and determined. Knowing the first two rows in the rotation matrix, the values of the elements in third row, i.e., r31, r32, and r33, are computed using the orthonormal property of the rotation matrix, i.e. taking the cross product of first two rows. At this stage, we are left with t3, which can be estimated along with the intrinsic parameters.


Intrinsic Parameter Estimation


Now the vector product of Equation (26) on both sides by pji is used to obtain:












λ
j

·

p
j


×

p
j


=



p
j

×


[




r
1




r
2




r
3



T



]

·

[




X
j






Y
j






Z
j





1



]



=
0





(
32
)







=
Δ





[




u
j






u
j







a
0

+


a

2








ρ
j
2


+

+


a
N



ρ
j
N






]

×


[




r
1




r
2




r
3



T



]

·

[




X
j






Y
j






Z
j





1



]



=
0














Solving Equation (32), the following three homogeneous equations are obtained:

v′j(r31Xj+r32Yj+r33Zj+t3)−(a0+a2ρj2+ . . . +aNρjN)(r21Xj+r22Yj+r23Zj+t2)=0  (33)
(a0+a2ρj2+ . . . +aNρjN)(r11Xj+r12Yj+r13Zj+t1)−u′j(r31Xj+r32Yj+r33Zj+t3)=0  (34)
u′j(r21Xj+r22Yj+r23Zj+t2)−v′j(r11Xj+r12Yj+r13Zj+t1)=0  (35)

Setting r21Xj+r22Yj+r23Zj+t2=Aj, and r11Xj+r12Yj+r13Zj+t1=Cj, Equations (33) and (34) can be rewritten as:

v′j(r31Xj+r32Yj+r33Zj+t3)−(a0+a2ρj2+ . . . +aNρjNAj=(a0+a2ρj2+ . . . +aNρjNCj−u′j(r31Xj+r32Yj+r33Zj+t3)  (36)


Equation (36) can be written as following system of equations:











(
36
)















[

(


A
j

+

C
j


)






(


A
j

+

C
j


)

·

ρ
j
2








(


A
j

+

C
j


)

·

ρ
j
3




















(


A
j

+

C
j


)

·

ρ
j
N







-

(


v
j


+

u
j



)


]


















[








a
0






a
2






a
3











a
N






t
3








]





=


(


v
j


+

u
j



)

·

(



r
31



X
j


+


r
32



Y
j


+


r
33



Z
j



)









The above system of equation can be solved using singular value decomposition (SVD) method for N+1 unknowns. Although the Eq. (36) will have infinitely many solutions, the SVD method will give a solution with norm smaller than the norm of any other solution.


But the polynomial coefficients and translation in z-direction i.e. t3 in Equation (36) are coupled. So the estimate will be an ambiguous solution. In order to avoid this ambiguity, the value of t3 should be known a-priory, which is doable in the proposed 3-dimensional setup. With these changes, Equation (36) is modified as follows:










[




(


A
j

+

C
j


)





(


A
j

+

C
j


)

·

ρ
j
2






(


A
j

+

C
j


)

·

ρ
j
3









(


A
j

+

C
j


)

·

ρ
j
N





]






[




a
0






a
2






a
3











a
N




]

=



(


v
j


+

u
j



)

·

(



r
31



X
j


+


r
32



Y
j


+


r
33



Z
j



)


+


(


v
j


+

u
j



)

×

t
3









(
37
)








The above system of equation can be solved using SVD method for N unknowns, which are coefficients of Taylor polynomial. By eliminating t3 leads to (38) as our final equation.


Linear Refinement of Intrinsic and Extrinsic Parameters


This step may not improve accuracy any further so is not carried out in case of 3D calibration pattern.


Center of Distortion Detection


The center of distortion is detected similar to the sections above.


Nonlinear Refinement of Intrinsic and Extrinsic Parameters


Nonlinear refinement of calibration parameters is carried out similar to the above sections when necessary. The stretch matrix A as well as the center of distortion Oc is also refined in this step. But using 3D calibration points, the results are already greatly improved as compared to the original OCamCalib method, thus this step can be eliminated.


Novelty of 3D Calibration Points Design


Apart from the estimation method presented above, another novelty of invention is design of distribution of 3D calibration in space in form of a (semi-)sphere as shown in FIGS. 5 and 6. The design of FIGS. 5 and 6 provides a calibration point in space which are uniformly distributed over the entire image. This provides an opportunity to compute re-projection error over entire image thus a better estimate is achieved in Equation (36) (37).


Therefore, the present invention provides enhanced camera calibration for a vehicle vision system. It was acknowledged that using a monoview noncoplanar (3-dimensional) calibration pattern instead of a coplanar calibration pattern is beneficial to reduce the re-projection error. The equal distribution of the calibration points (equal angular distance and constant distance to the camera (radius)) is a preferred point (inserting r3 in Equations (26) and (27)). Applying Tsai's formulas to estimate camera extrinsic in Scaramuzza's model and intrinsic using the present invention provides enhanced calibration. Furthermore, 3D geometry of target points leads to much more accurate principal point estimation as compared to the currently available OCamCalib model. It was possible to eliminate t3 in equation (37), by that the formula was reduced to equation (38).


A 3D test pattern test bench for fish eye camera calibration was created according these mathematical insights as to be seen in FIGS. 5 and 6. Such a set up was unknown for fish eye camera calibration.


The camera or sensor may comprise any suitable camera or sensor. Optionally, the camera may comprise a “smart camera” that includes the imaging sensor array and associated circuitry and image processing circuitry and electrical connectors and the like as part of a camera module, such as by utilizing aspects of the vision systems described in International Publication Nos. WO 2013/081984 and/or WO 2013/081985, which are hereby incorporated herein by reference in their entireties.


The system includes an image processor operable to process image data captured by the camera or cameras, such as for detecting objects or other vehicles or pedestrians or the like in the field of view of one or more of the cameras. For example, the image processor may comprise an EyeQ2 or EyeQ3 image processing chip available from Mobileye Vision Technologies Ltd. of Jerusalem, Israel, and may include object detection software (such as the types described in U.S. Pat. Nos. 7,855,755; 7,720,580 and/or 7,038,577, which are hereby incorporated herein by reference in their entireties), and may analyze image data to detect vehicles and/or other objects. Responsive to such image processing, and when an object or other vehicle is detected, the system may generate an alert to the driver of the vehicle and/or may generate an overlay at the displayed image to highlight or enhance display of the detected object or vehicle, in order to enhance the driver's awareness of the detected object or vehicle or hazardous condition during a driving maneuver of the equipped vehicle.


The vehicle may include any type of sensor or sensors, such as imaging sensors or radar sensors or lidar sensors or ladar sensors or ultrasonic sensors or the like. The imaging sensor or camera may capture image data for image processing and may comprise any suitable camera or sensing device, such as, for example, a two dimensional array of a plurality of photosensor elements arranged in at least 640 columns and 480 rows (at least a 640×480 imaging array, such as a megapixel imaging array or the like), with a respective lens focusing images onto respective portions of the array. The photosensor array may comprise a plurality of photosensor elements arranged in a photosensor array having rows and columns. Preferably, the imaging array has at least 300,000 photosensor elements or pixels, more preferably at least 500,000 photosensor elements or pixels and more preferably at least 1 million photosensor elements or pixels. The imaging array may capture color image data, such as via spectral filtering at the array, such as via an RGB (red, green and blue) filter or via a red/red complement filter or such as via an RCC (red, clear, clear) filter or the like. The logic and control circuit of the imaging sensor may function in any known manner, and the image processing and algorithmic processing may comprise any suitable means for processing the images and/or image data.


For example, the vision system and/or processing and/or camera and/or circuitry may utilize aspects described in U.S. Pat. Nos. 7,005,974; 5,760,962; 5,877,897; 5,796,094; 5,949,331; 6,222,447; 6,302,545; 6,396,397; 6,498,620; 6,523,964; 6,611,202; 6,201,642; 6,690,268; 6,717,610; 6,757,109; 6,802,617; 6,806,452; 6,822,563; 6,891,563; 6,946,978; 7,859,565; 5,550,677; 5,670,935; 6,636,258; 7,145,519; 7,161,616; 7,230,640; 7,248,283; 7,295,229; 7,301,466; 7,592,928; 7,881,496; 7,720,580; 7,038,577; 6,882,287; 5,929,786 and/or 5,786,772, which are all hereby incorporated herein by reference in their entireties. The system may communicate with other communication systems via any suitable means, such as by utilizing aspects of the systems described in International Publication Nos. WO/2010/144900; WO 2013/043661 and/or WO 2013/081985, and/or U.S. Pat. No. 9,126,525, which are hereby incorporated herein by reference in their entireties.


The imaging device and control and image processor and any associated illumination source, if applicable, may comprise any suitable components, and may utilize aspects of the cameras and vision systems described in U.S. Pat. Nos. 5,550,677; 5,877,897; 6,498,620; 5,670,935; 5,796,094; 6,396,397; 6,806,452; 6,690,268; 7,005,974; 7,937,667; 7,123,168; 7,004,606; 6,946,978; 7,038,577; 6,353,392; 6,320,176; 6,313,454 and/or 6,824,281, and/or International Publication Nos. WO 2010/099416; WO 2011/028686 and/or WO 2013/016409, and/or U.S. Pat. Publication Nos. US 2010-0020170 and/or US-2013-0002873, which are all hereby incorporated herein by reference in their entireties. The camera or cameras may comprise any suitable cameras or imaging sensors or camera modules, and may utilize aspects of the cameras or sensors described in U.S. Publication No. US-2009-0244361 and/or U.S. Pat. Nos. 8,542,451; 7,965,336 and/or 7,480,149, which are hereby incorporated herein by reference in their entireties. The imaging array sensor may comprise any suitable sensor, and may utilize various imaging sensors or imaging array sensors or cameras or the like, such as a CMOS imaging array sensor, a CCD sensor or other sensors or the like, such as the types described in U.S. Pat. Nos. 5,550,677; 5,670,935; 5,760,962; 5,715,093; 5,877,897; 6,922,292; 6,757,109; 6,717,610; 6,590,719; 6,201,642; 6,498,620; 5,796,094; 6,097,023; 6,320,176; 6,559,435; 6,831,261; 6,806,452; 6,396,397; 6,822,563; 6,946,978; 7,339,149; 7,038,577; 7,004,606; 7,720,580 and/or 7,965,336, and/or International Publication Nos. WO/2009/036176 and/or WO/2009/046268, which are all hereby incorporated herein by reference in their entireties.


The camera module and circuit chip or board and imaging sensor may be implemented and operated in connection with various vehicular vision-based systems, and/or may be operable utilizing the principles of such other vehicular systems, such as a vehicle headlamp control system, such as the type disclosed in U.S. Pat. Nos. 5,796,094; 6,097,023; 6,320,176; 6,559,435; 6,831,261; 7,004,606; 7,339,149 and/or 7,526,103, which are all hereby incorporated herein by reference in their entireties, a rain sensor, such as the types disclosed in commonly assigned U.S. Pat. Nos. 6,353,392; 6,313,454; 6,320,176 and/or 7,480,149, which are hereby incorporated herein by reference in their entireties, a vehicle vision system, such as a forwardly, sidewardly or rearwardly directed vehicle vision system utilizing principles disclosed in U.S. Pat. Nos. 5,550,677; 5,670,935; 5,760,962; 5,877,897; 5,949,331; 6,222,447; 6,302,545; 6,396,397; 6,498,620; 6,523,964; 6,611,202; 6,201,642; 6,690,268; 6,717,610; 6,757,109; 6,802,617; 6,806,452; 6,822,563; 6,891,563; 6,946,978 and/or 7,859,565, which are all hereby incorporated herein by reference in their entireties, a trailer hitching aid or tow check system, such as the type disclosed in U.S. Pat. No. 7,005,974, which is hereby incorporated herein by reference in its entirety, a reverse or sideward imaging system, such as for a lane change assistance system or lane departure warning system or for a blind spot or object detection system, such as imaging or detection systems of the types disclosed in U.S. Pat. Nos. 7,881,496; 7,720,580; 7,038,577; 5,929,786 and/or 5,786,772, which are hereby incorporated herein by reference in their entireties, a video device for internal cabin surveillance and/or video telephone function, such as disclosed in U.S. Pat. Nos. 5,760,962; 5,877,897; 6,690,268 and/or 7,370,983, and/or U.S. Publication No. US-2006-0050018, which are hereby incorporated herein by reference in their entireties, a traffic sign recognition system, a system for determining a distance to a leading or trailing vehicle or object, such as a system utilizing the principles disclosed in U.S. Pat. Nos. 6,396,397 and/or 7,123,168, which are hereby incorporated herein by reference in their entireties, and/or the like.


Optionally, the vision system may include a display for displaying images captured by one or more of the imaging sensors for viewing by the driver of the vehicle while the driver is normally operating the vehicle. Optionally, the display may utilize aspects of the displays disclosed in U.S. Pat. Nos. 5,530,240; 6,329,925; 7,855,755; 7,626,749; 7,581,859; 7,446,650; 7,370,983; 7,338,177; 7,274,501; 7,255,451; 7,195,381; 7,184,190; 5,668,663; 5,724,187 and/or 6,690,268, and/or in U.S. Publication Nos. US-2006-0061008 and/or US-2006-0050018, which are all hereby incorporated herein by reference in their entireties.


Optionally, the vision system (utilizing the forward facing camera and a rearward facing camera and other cameras disposed at the vehicle with exterior fields of view) may be part of or may provide a display of a top-down view or birds-eye view system of the vehicle or a surround view at the vehicle, such as by utilizing aspects of the vision systems described in International Publication Nos. WO 2010/099416; WO 2011/028686; WO 2012/075250; WO 2013/019795; WO 2012/075250; WO 2012/145822; WO 2013/081985; WO 2013/086249 and/or WO 2013/109869, and/or U.S. Publication No. US-2012-0162427, which are hereby incorporated herein by reference in their entireties.


Changes and modifications in the specifically described embodiments can be carried out without departing from the principles of the invention, which is intended to be limited only by the scope of the appended claims, as interpreted according to the principles of patent law including the doctrine of equivalents.

Claims
  • 1. A method for calibrating a camera of a vehicular vision system, said method comprising: providing a camera at a vehicle so as to have a field of view exterior of the vehicle;wherein the camera comprises a pixelated imaging array having a plurality of photosensing elements;providing an image processor at the vehicle, wherein the image processor is operable to process image data captured by the camera;capturing image data via the camera;processing image data captured by the camera;determining, at least in part via processing of image data captured by the camera, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of the camera and estimating intrinsic parameters of the camera;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters;responsive to processing by the image processor of image data captured by the camera, calibrating the camera at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern; andwherein calibrating the camera comprises using a Taylor model.
  • 2. The method of claim 1, wherein values of distortion polynomial coefficients for the Taylor model are estimated using three dimensional calibration points distributed on the semi-sphere.
  • 3. The method of claim 1, comprising transferring image data captured by the camera to an electronic control unit via a communication link of the vehicle.
  • 4. A method for calibrating a camera of a vehicular vision system, said method comprising: providing a camera at a vehicle so as to have a field of view exterior of the vehicle;wherein the camera comprises a pixelated imaging array having a plurality of photosensing elements;providing an image processor at the vehicle, wherein the image processor is operable to process image data captured by the camera;capturing image data via the camera;transferring image data captured by the camera to an electronic control unit via a communication link of the vehicle;wherein the communication link comprises a vehicle network bus of the vehicle;processing image data captured by the camera;determining, at least in part via processing of image data captured by the camera, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of the camera and estimating intrinsic parameters of the camera;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters;responsive to processing by the image processor of image data captured by the camera, calibrating the camera at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern.
  • 5. The method of claim 4, wherein providing a camera comprises providing a plurality of cameras at the vehicle so as to have respective fields of view exterior of the vehicle, wherein providing the plurality of cameras comprises (i) providing a forward viewing camera at the vehicle having a field of view at least forward of the vehicle, (ii) providing a rearward viewing camera at the vehicle having a field of view at least rearward of the vehicle, (iii) providing a driver side viewing camera at the vehicle having a field of view at least sideward of a driver side of the vehicle, and (iv) providing a passenger side viewing camera at the vehicle having a field of view at least sideward of a passenger side of the vehicle.
  • 6. The method of claim 5, wherein the image processor is operable to process image data captured by the cameras of the plurality of cameras, and wherein the vision system calibrates each of the cameras of the plurality of cameras at least in part by using the monoview noncoplanar three dimensional semi-spherical calibration pattern.
  • 7. The method of claim 4, wherein performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters comprises performing a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters.
  • 8. A method for calibrating a camera of a vehicular vision system, said method comprising: providing a camera at a vehicle so as to have a field of view exterior of the vehicle:wherein the camera comprises a pixelated imaging array having a plurality of photosensing elements;providing an image processor at the vehicle, wherein the image processor is operable to process image data captured by the camera;capturing image data via the camera;processing image data captured by the camera;determining, at least in part via processing of image data captured by the camera, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of the camera and estimating intrinsic parameters of the camera;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters;responsive to processing by the image processor of image data captured by the camera, calibrating the camera at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern; andwherein calibrating the camera comprises detecting a position of a center of the camera using an iterative search algorithm by minimizing the sum of squared re-projection errors (SSRE).
  • 9. A method for calibrating a camera of a vehicular vision system, said method comprising: providing a camera at a vehicle so as to have a field of view exterior of the vehicle;wherein the camera comprises a pixelated imaging array having a plurality of photosensing elements;providing an image processor at the vehicle, wherein the image processor is operable to process image data captured by the camera;capturing image data via the camera;processing image data captured by the camera;determining, at least in part via processing of image data captured by the camera, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of the camera and estimating intrinsic parameters of the camera;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters;responsive to processing by the image processor of image data captured by the camera, calibrating the camera at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern; andwherein performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters comprises performing a linear refinement of the estimated extrinsic parameters and intrinsic parameters.
  • 10. A method for calibrating a camera of a vehicular vision system, said method comprising: providing a camera at a vehicle so as to have a field of view exterior of the vehicle;wherein the camera comprises a fish eye lens;wherein the camera comprises a pixelated imaging array having a plurality of photosensing elements;providing an image processor at the vehicle, wherein the image processor is operable to process image data captured by the camera;capturing image data via the camera;transferring image data captured by the camera to an electronic control unit of the vehicle, wherein the electronic control unit comprises the image processor;processing image data captured by the camera;determining, at least in part via processing of image data captured by the camera, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of the camera and estimating intrinsic parameters of the camera;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters;responsive to processing by the image processor of image data captured by the camera, calibrating the camera at least in part by using a Taylor model and the determined monoview noncoplanar three dimensional semi-spherical calibration pattern; andwherein values of distortion polynomial coefficients for the Taylor model are estimated using three dimensional calibration points distributed on the semi-sphere.
  • 11. The method of claim 10, wherein image data captured by the camera is transferred to the electronic control unit of the vehicle via a communication link of the vehicle, and wherein the communication link comprises a vehicle network bus of the vehicle.
  • 12. The method of claim 10, wherein calibrating the camera comprises detecting a position of a center of the camera using an iterative search algorithm by minimizing the sum of squared re-projection errors (SSRE).
  • 13. The method of claim 10, wherein performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters comprises performing a linear refinement of the estimated extrinsic parameters and intrinsic parameters.
  • 14. The method of claim 10, wherein performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters comprises performing a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters.
  • 15. A method for calibrating at least some cameras of a vehicular vision system, said method comprising: providing a plurality of cameras at a vehicle so as to have respective fields of view exterior of the vehicle;wherein providing the plurality of cameras comprises (i) providing a forward viewing camera at the vehicle having a field of view at least forward of the vehicle, (ii) providing a rearward viewing camera at the vehicle having a field of view at least rearward of the vehicle, (iii) providing a driver side viewing camera at the vehicle having a field of view at least sideward of a driver side of the vehicle, and (iv) providing a passenger side viewing camera at the vehicle having a field of view at least sideward of a passenger side of the vehicle;wherein each of the cameras comprises a pixelated imaging array having a plurality of photosensing elements;transferring image data captured by the camera to an electronic control unit of the vehicle via a communication link of the vehicle, wherein the communication link comprises a vehicle network bus of the vehicle;wherein the electronic control unit comprises an image processor, and wherein the image processor is operable to process image data captured by the cameras;capturing image data via the cameras;processing image data captured by the cameras;determining, via processing of image data captured by at least one of the cameras, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of at least one of the cameras and estimating intrinsic parameters of the at least one of the cameras;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters; andresponsive to processing by the image processor of image data captured by the at least one of the cameras, calibrating the at least one of the cameras at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern.
  • 16. The method of claim 15, wherein the vision system calibrates each camera of the plurality of cameras at least in part by using the monoview noncoplanar three dimensional semi-spherical calibration pattern.
  • 17. The method of claim 15, wherein performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters comprises performing a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters.
  • 18. A method for calibrating at least some cameras of a vehicular vision system, said method comprising: providing a plurality of cameras at a vehicle so as to have respective fields of view exterior of the vehicle;wherein providing the plurality of cameras comprises (i) providing a forward viewing camera at the vehicle having a field of view at least forward of the vehicle, (ii) providing a rearward viewing camera at the vehicle having a field of view at least rearward of the vehicle, (iii) providing a driver side viewing camera at the vehicle having a field of view at least sideward of a driver side of the vehicle, and (iv) providing a passenger side viewing camera at the vehicle having a field of view at least sideward of a passenger side of the vehicle;wherein each of the cameras comprises a pixelated imaging array having a plurality of photosensing elements;providing an image processor at the vehicle, wherein the image processor is operable to process image data captured by the cameras;capturing image data via the cameras;processing image data captured by the cameras;determining, via processing of image data captured by at least one of the cameras, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of at least one of the cameras and estimating intrinsic parameters of the at least one of the cameras;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters;responsive to processing by the image processor of image data captured by the at least one of the cameras, calibrating the at least one of the cameras at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern; andwherein calibrating the at least one of the cameras comprises detecting a position of a center of the at least one of the cameras using an iterative search algorithm by minimizing the sum of squared re-projection errors (SSRE).
  • 19. A method for calibrating at least some cameras of a vehicular vision system, said method comprising: providing a plurality of cameras at a vehicle so as to have respective fields of view exterior of the vehicle;wherein providing the plurality of cameras comprises (i) providing a forward viewing camera at the vehicle having a field of view at least forward of the vehicle, (ii) providing a rearward viewing camera at the vehicle having a field of view at least rearward of the vehicle, (iii) providing a driver side viewing camera at the vehicle having a field of view at least sideward of a driver side of the vehicle, and (iv) providing a passenger side viewing camera at the vehicle having a field of view at least sideward of a passenger side of the vehicle;wherein each of the cameras comprises a pixelated imaging array having a plurality of photosensing elements;providing an image processor at the vehicle, wherein the image processor is operable to process image data captured by the cameras;capturing image data via the cameras;processing image data captured by the cameras;determining, via processing of image data captured by at least one of the cameras, a monoview noncoplanar three dimensional calibration pattern distributed on a semi-sphere;responsive to determination of the monoview noncoplanar three dimensional calibration pattern distributed on the semi-sphere, estimating extrinsic parameters of at least one of the cameras and estimating intrinsic parameters of the at least one of the cameras;performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters;responsive to processing by the image processor of image data captured by the at least one of the cameras, calibrating the at least one of the cameras at least in part by using the determined monoview noncoplanar three dimensional semi-spherical calibration pattern; andwherein performing at least one of (i) a linear refinement of the estimated extrinsic parameters and intrinsic parameters and (ii) a non-linear refinement of the estimated extrinsic parameters and intrinsic parameters comprises performing a linear refinement of the estimated extrinsic parameters and intrinsic parameters.
CROSS REFERENCE TO RELATED APPLICATIONS

The present application is a continuation of U.S. patent application Ser. No. 14/996,571, filed Jan. 15, 2016, now U.S. Pat. No. 9,916,660, which claims the filing benefits of U.S. provisional application Ser. No. 62/104,288, filed Jan. 16, 2015, which is hereby incorporated herein by reference in its entirety.

US Referenced Citations (261)
Number Name Date Kind
4961625 Wood et al. Oct 1990 A
4966441 Conner Oct 1990 A
4967319 Seko Oct 1990 A
4970653 Kenue Nov 1990 A
5003288 Wilhelm Mar 1991 A
5059877 Teder Oct 1991 A
5064274 Alten Nov 1991 A
5072154 Chen Dec 1991 A
5096287 Kakinami et al. Mar 1992 A
5148014 Lynam Sep 1992 A
5166681 Bottesch et al. Nov 1992 A
5177606 Koshizawa Jan 1993 A
5182502 Slotkowski et al. Jan 1993 A
5193029 Schofield Mar 1993 A
5204778 Bechtel Apr 1993 A
5208701 Maeda May 1993 A
5208750 Kurami et al. May 1993 A
5214408 Asayama May 1993 A
5243524 Ishida et al. Sep 1993 A
5245422 Borcherts et al. Sep 1993 A
5276389 Levers Jan 1994 A
5289321 Secor Feb 1994 A
5305012 Faris Apr 1994 A
5307136 Saneyoshi Apr 1994 A
5351044 Mathur et al. Sep 1994 A
5355118 Fukuhara Oct 1994 A
5386285 Asayama Jan 1995 A
5406395 Wilson et al. Apr 1995 A
5408346 Trissel et al. Apr 1995 A
5414461 Kishi et al. May 1995 A
5426294 Kobayashi et al. Jun 1995 A
5430431 Nelson Jul 1995 A
5434407 Bauer et al. Jul 1995 A
5440428 Hegg et al. Aug 1995 A
5444478 Lelong et al. Aug 1995 A
5451822 Bechtel et al. Sep 1995 A
5469298 Suman et al. Nov 1995 A
5530420 Tsuchiya et al. Jun 1996 A
5535144 Kise Jul 1996 A
5535314 Alves et al. Jul 1996 A
5537003 Bechtel et al. Jul 1996 A
5539397 Asanuma et al. Jul 1996 A
5550677 Schofield et al. Aug 1996 A
5555555 Sato et al. Sep 1996 A
5568027 Teder Oct 1996 A
5574443 Hsieh Nov 1996 A
5648835 Uzawa Jul 1997 A
5661303 Teder Aug 1997 A
5670935 Schofield et al. Sep 1997 A
5699044 Van Lente et al. Dec 1997 A
5724316 Brunts Mar 1998 A
5737226 Olson et al. Apr 1998 A
5757949 Kinoshita et al. May 1998 A
5760826 Nayer Jun 1998 A
5760962 Schofield et al. Jun 1998 A
5761094 Olson et al. Jun 1998 A
5765116 Wilson-Jones et al. Jun 1998 A
5781437 Wiemer et al. Jul 1998 A
5786772 Schofield et al. Jul 1998 A
5790403 Nakayama Aug 1998 A
5790973 Blaker et al. Aug 1998 A
5796094 Schofield et al. Aug 1998 A
5837994 Stam et al. Nov 1998 A
5845000 Breed et al. Dec 1998 A
5848802 Breed et al. Dec 1998 A
5850176 Kinoshita et al. Dec 1998 A
5850254 Takano et al. Dec 1998 A
5867591 Onda Feb 1999 A
5877707 Kowalick Mar 1999 A
5877897 Schofield et al. Mar 1999 A
5878370 Olson Mar 1999 A
5896085 Mori et al. Apr 1999 A
5920367 Kajimoto et al. Jul 1999 A
5923027 Stam et al. Jul 1999 A
5929786 Schofield et al. Jul 1999 A
5956181 Lin Sep 1999 A
6049171 Stam et al. Apr 2000 A
6052124 Stein et al. Apr 2000 A
6066933 Ponziana May 2000 A
6084519 Coulling et al. Jul 2000 A
6091833 Yasui et al. Jul 2000 A
6097024 Stam et al. Aug 2000 A
6100811 Hsu et al. Aug 2000 A
6175300 Kendrick Jan 2001 B1
6198409 Schofield et al. Mar 2001 B1
6201642 Bos Mar 2001 B1
6226061 Tagusa May 2001 B1
6259423 Tokito et al. Jul 2001 B1
6266082 Yonezawa et al. Jul 2001 B1
6266442 Laumeyer et al. Jul 2001 B1
6285393 Shimoura et al. Sep 2001 B1
6285778 Nakajima et al. Sep 2001 B1
6294989 Schofield et al. Sep 2001 B1
6297781 Turnbull et al. Oct 2001 B1
6310611 Caldwell Oct 2001 B1
6313454 Bos et al. Nov 2001 B1
6317057 Lee Nov 2001 B1
6320282 Caldwell Nov 2001 B1
6353392 Schofield et al. Mar 2002 B1
6370329 Teuchert Apr 2002 B1
6396397 Bos et al. May 2002 B1
6411204 Bloomfield et al. Jun 2002 B1
6424273 Gutta et al. Jul 2002 B1
6445287 Schofield et al. Sep 2002 B1
6477464 McCarthy et al. Nov 2002 B2
6498620 Schofield et al. Dec 2002 B2
6515378 Drummond et al. Feb 2003 B2
6516664 Lynam Feb 2003 B2
6553130 Lemelson et al. Apr 2003 B1
6570998 Ohtsuka et al. May 2003 B1
6574033 Chui et al. Jun 2003 B1
6578017 Ebersole et al. Jun 2003 B1
6587573 Stam et al. Jul 2003 B1
6589625 Kothari et al. Jul 2003 B1
6593011 Liu et al. Jul 2003 B2
6593565 Heslin et al. Jul 2003 B2
6593698 Stam et al. Jul 2003 B2
6594583 Ogura et al. Jul 2003 B2
6611610 Stam et al. Aug 2003 B1
6627918 Getz et al. Sep 2003 B2
6631316 Stam et al. Oct 2003 B2
6631994 Suzuki et al. Oct 2003 B2
6636258 Strumolo Oct 2003 B2
6648477 Hutzel et al. Nov 2003 B2
6650233 DeLine et al. Nov 2003 B2
6650455 Miles Nov 2003 B2
6672731 Schnell et al. Jan 2004 B2
6674562 Miles Jan 2004 B1
6678056 Downs Jan 2004 B2
6678614 McCarthy et al. Jan 2004 B2
6680792 Miles Jan 2004 B2
6690268 Schofield et al. Feb 2004 B2
6700605 Toyoda et al. Mar 2004 B1
6703925 Steffel Mar 2004 B2
6704621 Stein et al. Mar 2004 B1
6710908 Miles et al. Mar 2004 B2
6711474 Treyz et al. Mar 2004 B1
6714331 Lewis et al. Mar 2004 B2
6717610 Bos et al. Apr 2004 B1
6735506 Breed et al. May 2004 B2
6741377 Miles May 2004 B2
6744353 Sjönell Jun 2004 B2
6757109 Bos Jun 2004 B2
6762867 Lippert et al. Jul 2004 B2
6794119 Miles Sep 2004 B2
6795221 Urey Sep 2004 B1
6806452 Bos et al. Oct 2004 B2
6807287 Hermans Oct 2004 B1
6822563 Bos et al. Nov 2004 B2
6823241 Shirato et al. Nov 2004 B2
6824281 Schofield et al. Nov 2004 B2
6864930 Matsushita et al. Mar 2005 B2
6882287 Schofield Apr 2005 B2
6889161 Winner et al. May 2005 B2
6909753 Meehan et al. Jun 2005 B2
6946978 Schofield Sep 2005 B2
6968736 Lynam Nov 2005 B2
6975775 Rykowski et al. Dec 2005 B2
7004606 Schofield Feb 2006 B2
7038577 Pawlicki et al. May 2006 B2
7062300 Kim Jun 2006 B1
7065432 Moisel et al. Jun 2006 B2
7085637 Breed et al. Aug 2006 B2
7092548 Laumeyer et al. Aug 2006 B2
7113867 Stein Sep 2006 B1
7116246 Winter et al. Oct 2006 B2
7123168 Schofield Oct 2006 B2
7133661 Hatae et al. Nov 2006 B2
7149613 Stam et al. Dec 2006 B2
7151996 Stein Dec 2006 B2
7167796 Taylor et al. Jan 2007 B2
7195381 Lynam et al. Mar 2007 B2
7202776 Breed Apr 2007 B2
7227459 Bos et al. Jun 2007 B2
7227611 Hull et al. Jun 2007 B2
7325934 Schofield et al. Feb 2008 B2
7325935 Schofield et al. Feb 2008 B2
7338177 Lynam Mar 2008 B2
7375803 Bamji May 2008 B1
7380948 Schofield et al. Jun 2008 B2
7388182 Schofield et al. Jun 2008 B2
7423821 Bechtel et al. Sep 2008 B2
7425076 Schofield et al. Sep 2008 B2
7526103 Schofield et al. Apr 2009 B2
7541743 Salmeen et al. Jun 2009 B2
7565006 Stam et al. Jul 2009 B2
7566851 Stein et al. Jul 2009 B2
7605856 Imoto Oct 2009 B2
7619508 Lynam et al. Nov 2009 B2
7720580 Higgins-Luthman May 2010 B2
7786898 Stein et al. Aug 2010 B2
7792329 Schofield et al. Sep 2010 B2
7843451 Lafon Nov 2010 B2
7855778 Yung et al. Dec 2010 B2
7881496 Camilleri Feb 2011 B2
7914187 Higgins-Luthman et al. Mar 2011 B2
7914188 DeLine et al. Mar 2011 B2
7930160 Hosagrahara et al. Apr 2011 B1
7949486 Denny et al. May 2011 B2
8017898 Lu et al. Sep 2011 B2
8064643 Stein et al. Nov 2011 B2
8082101 Stein et al. Dec 2011 B2
8100568 DeLine et al. Jan 2012 B2
8164628 Stein et al. Apr 2012 B2
8224031 Saito Jul 2012 B2
8233045 Luo et al. Jul 2012 B2
8254635 Stein et al. Aug 2012 B2
8300886 Hoffmann Oct 2012 B2
8378851 Stein et al. Feb 2013 B2
8421865 Euler et al. Apr 2013 B2
8452055 Stein et al. May 2013 B2
8534887 DeLine et al. Sep 2013 B2
8553088 Stein et al. Oct 2013 B2
9916660 Singh Mar 2018 B2
20020005778 Breed Jan 2002 A1
20020011611 Huang et al. Jan 2002 A1
20020113873 Williams Aug 2002 A1
20030103142 Hitomi et al. Jun 2003 A1
20030137586 Lewellen Jul 2003 A1
20030222982 Hamdan et al. Dec 2003 A1
20040164228 Fogg et al. Aug 2004 A1
20050219852 Stam et al. Oct 2005 A1
20050237385 Kosaka et al. Oct 2005 A1
20060050018 Hutzel et al. Mar 2006 A1
20060091813 Stam et al. May 2006 A1
20060103727 Tseng May 2006 A1
20060250501 Wldmann et al. Nov 2006 A1
20070024724 Stein et al. Feb 2007 A1
20070104476 Yasutomi et al. May 2007 A1
20070242339 Bradley Oct 2007 A1
20080043099 Stein et al. Feb 2008 A1
20080147321 Howard et al. Jun 2008 A1
20080192132 Bechtel et al. Aug 2008 A1
20080266396 Stein Oct 2008 A1
20090113509 Tseng et al. Apr 2009 A1
20090160987 Bechtel et al. Jun 2009 A1
20090190015 Bechtel et al. Jul 2009 A1
20090256938 Bechtel et al. Oct 2009 A1
20090290032 Zhang et al. Nov 2009 A1
20110216201 McAndrew et al. Sep 2011 A1
20120045112 Lundblad et al. Feb 2012 A1
20120069185 Stein Mar 2012 A1
20120200707 Stein et al. Aug 2012 A1
20120314071 Rosenbaum et al. Dec 2012 A1
20120320209 Vico Dec 2012 A1
20130070094 Majumder Mar 2013 A1
20130141580 Stein et al. Jun 2013 A1
20130147957 Stein Jun 2013 A1
20130169812 Lu et al. Jul 2013 A1
20130286193 Pflug Oct 2013 A1
20140028861 Holz Jan 2014 A1
20140043473 Rathi et al. Feb 2014 A1
20140063254 Shi et al. Mar 2014 A1
20140098229 Lu et al. Apr 2014 A1
20140104424 Zhang Apr 2014 A1
20140247352 Rathi et al. Sep 2014 A1
20140247354 Knudsen Sep 2014 A1
20140320658 Pliefke Oct 2014 A1
20140333729 Pflug Nov 2014 A1
20140347486 Okouneva Nov 2014 A1
20140350834 Turk Nov 2014 A1
Foreign Referenced Citations (27)
Number Date Country
0353200 Jan 1990 EP
0361914 Feb 1993 EP
0640903 Mar 1995 EP
0697641 Feb 1996 EP
1115250 Jul 2001 EP
2377094 Oct 2011 EP
2667325 Nov 2013 EP
2233530 Sep 1991 GB
S5539843 Mar 1980 JP
S58110334 Jun 1983 JP
6216073 Apr 1987 JP
6272245 May 1987 JP
S62-131837 Jun 1987 JP
01123587 May 1989 JP
H1168538 Jul 1989 JP
H236417 Aug 1990 JP
03099952 Apr 1991 JP
6227318 Aug 1994 JP
07105496 Apr 1995 JP
2630604 Jul 1997 JP
200274339 Mar 2002 JP
20041658 Jan 2004 JP
WO1994019212 Feb 1994 WO
WO1996038319 Dec 1996 WO
WO2012139636 Oct 2012 WO
WO2012139660 Oct 2012 WO
WO2012143036 Oct 2012 WO
Non-Patent Literature Citations (20)
Entry
Achler et al., “Vehicle Wheel Detector using 2D Filter Banks,” IEEE Intelligent Vehicles Symposium of Jun. 2004.
Behringer et al., “Simultaneous Estimation of Pitch Angle and Lane Width from the Video Image of a Marked Road,” pp. 966-973, Sep. 12-16, 1994.
Borenstein et al., “Where am I? Sensors and Method for Mobile Robot Positioning”, University of Michigan, Apr. 1996, pp. 2, 125-128.
Bow, Sing T., “Pattern Recognition and Image Preprocessing (Signal Processing and Communications)”, CRC Press, Jan. 15, 2002, pp. 557-559.
Broggi et al., “Automatic Vehicle Guidance: The Experience of the ARGO Vehicle”, World Scientific Publishing Co., 1999.
Broggi et al., “Multi-Resolution Vehicle Detection using Artificial Vision,” IEEE Intelligent Vehicles Symposium of Jun. 2004.
Franke et al., “Autonomous driving approaches downtown”, Intelligent Systems and Their Applications, IEEE 13 (6), 40-48, Nov./Dec. 1999.
IEEE 100—The Authoritative Dictionary of IEEE Standards Terms, 7th Ed. (2000).
Kastrinaki et al., “A survey of video processing techniques for traffic applications”.
Philomin et al., “Pedestrain Tracking from a Moving Vehicle”.
Sahli et al., “A Kalman Filter-Based Update Scheme for Road Following,” IAPR Workshop on Machine Vision Applications, pp. 5-9, Nov. 12-14, 1996.
Scaramuzza, David E.,“Omidirectional Vision: From Calibration to Robot Motion Estimation,” A dissertation submitted to Eth Zurich, M.S. Electronic Engineering, Universita di Perugia, Italy, 2008.
Sun et al., “On-road vehicle detection using optical sensors: a review”, IEEE Conference on Intelligent Transportation Systems, 2004.
Tsai, Robert Y., “A Versatile Camera Calibration Technique for High-Accuracy 3D Machine Vision Metrology Using Off-the-Shelf TV Cameras and Lenses,” IEEE, 1987.
Van Leeuwen et al., “Motion Estimation with a Mobile Camera for Traffic Applications”, IEEE, US, vol. 1, Oct. 3, 2000, pp. 58-63.
Van Leeuwen et al., “Motion Interpretation for In-Car Vision Systems”, IEEE, US, vol. 1, Sep. 30, 2002, p. 135-140.
Van Leeuwen et al., “Real-Time Vehicle Tracking in Image Sequences”, IEEE, US, vol. 3, May 21, 2001, pp. 2049-2054, XP010547308.
Van Leeuwen et al., “Requirements for Motion Estimation in Image Sequences for Traffic Applications”, IEEE, US, vol. 1, May 24, 1999, pp. 145-150, XP010340272.
Vlacic et al. (Eds), “Intelligent Vehicle Technologies, Theory and Applications”, Society of Automotive Engineers Inc., edited by SAE International, 2001.
Zheng et al., “An Adaptive System for Traffic Sign Recognition,” IEEE Proceedings of the Intelligent Vehicles '94 Symposium, pp. 165-170 (Oct. 1994).
Related Publications (1)
Number Date Country
20180197310 A1 Jul 2018 US
Provisional Applications (1)
Number Date Country
62104288 Jan 2015 US
Continuations (1)
Number Date Country
Parent 14996571 Jan 2016 US
Child 15914059 US