! ! ! 

! 

•  – 

– 

– 

– 

–  – 

!

•  –  – 

€

x = xL + xR2

LxL − xR

€

y = yLL

xL − xR

€

z = f LxL − xR

xL-xR

L

○

→

C 1 :

P :

M 2

C 2

L 2 L 1

M 1

p "P C1 M1 P C2

L1 "

! ! 

! 

! 

! 

C 1 :

P :

M 2

C 2

L 2 L 1

M 1

•  –  – 

• 

– cf. !

– 

CCD

•  - –  – 

• 

–  – 

•  – 

– 

• 

• 

• 

X Y

Z x y f

f

x

X

Z

€

x = f XZ

y = f YZ

"

# $

% $

•  – 

h !

–  “1”

€

x = f XZ

y = f YZ

"

# $

% $

€

hxy1

"

#

$ $ $

%

&

' ' '

=

f 0 0 00 f 0 00 0 1 0

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

•  –  –  –  –  1.0 !

X Y

Z x y f

€

hxy1

"

#

$ $ $

%

&

' ' '

=

f 0 0 00 f 0 00 0 1 0

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

•  –  r11 r22 ! –  tx ~ ty !

€

x2y2

"

# $

%

& ' =

r11 r12r21 r22

"

# $

%

& ' xy"

# $ %

& ' +

txty

"

# $ %

& ' ⇔

x2y21

"

#

$ $ $

%

&

' ' '

=

r11 r12 txr21 r22 ty0 0 1

"

#

$ $ $

%

&

' ' '

xy1

"

#

$ $ $

%

&

' ' '

• 

– 

X

Y

Z

x y f

€

hxy1

"

#

$ $ $

%

&

' ' '

=

f 0 0 00 f 0 00 0 1 0

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

€

r11 r12 r13 tXr21 r22 r23 tYr31 r32 r33 tZ0 0 0 1

"

#

$ $ $ $

%

&

' ' ' '

•  –  f –  –  – 

x y

f

• 

– a : – s : –  tx, ty :

€

hxy1

"

#

$ $ $

%

&

' ' '

=

f 0 0 00 f 0 00 0 1 0

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

€

1 s tx0 a ty0 0 1

"

#

$ $ $

%

&

' ' '

• 

– 

– 

!€

hxy1

"

#

$ $ $

%

&

' ' '

=

1 s tx0 a ty0 0 1

"

#

$ $ $

%

&

' ' '

f 0 0 00 f 0 00 0 1 0

"

#

$ $ $

%

&

' ' '

r11 r12 r13 tXr21 r22 r23 tYr31 r32 r33 tZ0 0 0 1

"

#

$ $ $ $

%

&

' ' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

€

hxy1

"

#

$ $ $

%

&

' ' '

=

c11 c12 c13 c14c21 c22 c23 c24c31 c32 c33 c34

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

•  (X,Y,Z) ! (x,y) –  h

X

Y

Z

x y

f

€

hxy1

"

#

$ $ $

%

&

' ' '

=

c11 c12 c13 c14c21 c22 c23 c24c31 c32 c33 1

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

€

hx = c11X + c12Y + c13Z + c14hy = c21X + c22Y + c23Z + c24h = c31X + c32Y + c33Z +1

"

# $

% $

€

c31Xx + c32Yx + c33Zx + x = c11X + c12Y + c13Z + c14c31Xy + c32Yy + c33Zy + y = c21X + c22Y + c23Z + c24

" # $

•  11 2n n: – 

Ax=y

€

X1 Y1 Z1 1 0 0 0 0 −X1x1 −Y1x1 −Z1x10 0 0 0 X1 Y1 Z1 1 −X1y1 −Y1y1 −Z1y1

Xn Yn Zn 1 0 0 0 0 −Xnxn −Ynxn −Znxn0 0 0 0 Xn Yn Zn 1 −Xnyn −Ynyn −Znyn

#

$

% % % % % %

&

'

( ( ( ( ( (

c11c12c13c14c21c22c23c24c31c32c33

#

$

% % % % % % % % % % % % % % %

&

'

( ( ( ( ( ( ( ( ( ( ( ( ( ( (

=

x1y1xnyn

#

$

% % % % % %

&

'

( ( ( ( ( (

€

x = (AT A)−1AT y

x

y

 

y ax b= +

•  –  y = ax + b –  (xi, yi), i = 1,…,N

•  –  S = Σ(yi – a xi – b)2

•  –  S a,b dS/da=0, dS/db=0

0)(2)1()(2

0)(2)()(2

1 1

1 1

2

∑ ∑

∑ ∑

= =

= =

=−−−=−⋅−−=∂

∂

=−−−=−⋅−−=∂

∂

N

i

N

iiiii

N

i

N

iiiiiiii

baxybaxybS

bxaxxyxbaxyaS

∑∑∑

∑∑∑

===

===

+=

+=

N

i

N

ii

N

ii

N

ii

N

ii

N

iii

bxay

xbxaxy

111

11

2

1

1 !!!!

"

#

$$$$

%

&

=!"

#$%

&

!!!!

"

#

$$$$

%

&

∑

∑

∑∑

∑∑

=

=

==

==N

ii

N

iii

N

i

N

ii

N

ii

N

ii

y

xy

ba

x

xx

1

1

11

11

2

1

!!!!

"

#

$$$$

%

&

=!"

#$%

&

!!!!

"

#

$$$$

%

&

NN y

yy

ba

x

xx

!!!2

1

2

1

1

11

ii ybax =+

BAX =

BAAAX TT 1)( −=

16cm

•  Z. Y. Zhang – OpenCV Intel – GML C++ Camera Calibration toolbox

•  3x3 –  –  – 

€

hxy1

"

#

$ $ $

%

&

' ' '

=

f s ⋅ f tx0 a ⋅ f ty0 0 1

"

#

$ $ $

%

&

' ' '

r11 r12 r13 tXr21 r22 r23 tYr31 r32 r33 tZ

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

( 3x3

€

hxy1

"

#

$ $ $

%

&

' ' '

=

c11 c12 c13 c14c21 c22 c23 c24c31 c32 c33 c34

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

•  y – y

X

Y

Z

x y

f

€

hxy1

"

#

$ $ $

%

&

' ' '

=

c11 c12 c13 c14c21 c22 c23 c24c31 c32 c33 1

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

€

hxy1

"

#

$ $ $

%

&

' ' '

=

c11 c12 c13 c14c21 c22 c23 c24c31 c32 c33 1

"

#

$ $ $

%

&

' ' '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

€

hxp1

"

# $

%

& ' =

p11 p12 p13 p14p21 p22 p23 1"

# $

%

& '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

•  xp, x,y – 

– 

€

F =x ⋅ c34 − c14y ⋅ c34 − c24xp ⋅ p24 − p14

$

%

& & &

'

(

) ) ) Q =

c11 − x ⋅ c31 c12 − x ⋅ c32 c13 − x ⋅ c33c21 − y ⋅ c31 c22 − y ⋅ c32 c23 − y ⋅ c33p11 − xp ⋅ p21 p12 − xp ⋅ p22 p13 − xp ⋅ p23

$

%

& & &

'

(

) ) )

€

XYZ

"

#

$ $ $

%

&

' ' '

=Q−1 ⋅ F

• 

– 

! –  – 

!

!

•  – 

•  – y y

– 

€

hxp1

"

# $

%

& ' =

p11 p12 p13 p14p21 p22 p23 1"

# $

%

& '

XYZ1

"

#

$ $ $ $

%

&

' ' ' '

C 1 :

P :

M 2

C 2

L 2 L 1

M 1

F

C 1 :

P :

M 2

C 2 L 2 L 1

M 1

(x2,y2)

(x1,y1)

F

€

m1 =x1y11

"

#

$ $ $

%

&

' ' '

€

m2 =x2y21

"

#

$ $ $

%

&

' ' '

€

x1 y1 1[ ] ⋅ F ⋅x2y21

#

$

% % %

&

'

( ( (

= 0

€

m1T F m2 = 0

€

ax1 + by1 + c = 0

€

ax2 + by2 + c = 0