公式:
(
u
v
1
)
=
1
Z
(
f
x
0
c
x
0
f
y
c
y
0
0
1
)
(
X
Y
Z
)
=
1
Z
K
P
这里的
(
X
Y
Z
)
{
Z
P
u
v
=
Z
[
u
v
1
]
=
K
(
R
P
w
+
t
)
=
K
T
P
w
ZP_{uv} = Z{
把
P
c
P_c
Pc在相机坐标系下的点进行归一化,使得Z=1,即得到相机归一化平面
这时:
P
c
=
[
X
/
Z
Y
/
Z
1
]
P_c = {
畸变产生的原因:一是透镜自身的形状对光线传播的影响,二是在机械组装过程中,透镜和成像平面不可能完全平行,这也会使得光线穿过透镜投影到成像面时的位置发生变化。
主要包括径向畸变和切向畸变。
我们可以使用棋盘格进行标定,这一点张正友博士做了很多的工作。
考虑到视觉SLAM中一般都使用普通的摄像头,针孔模型及径向畸变和切向畸变模型已经足够。
我们小结一下单目相机的成像过程:
1.世界坐标系下的一个点
P
w
P_w
Pw.
2.
P
w
P_w
Pw转换到相机坐标系
P
c
P_c
Pc.
3.
P
c
P_c
Pc投影到归一化平面Z=1上,得到
P
c
′
P_c^{'}
Pc′
P
c
′
=
[
X
/
Z
Y
/
Z
1
]
P_c^{'}= {
4.
P
c
′
P_c^{'}
Pc′经过内参后,对应到它的像素坐标:
P
u
v
=
K
P
c
′
P_{uv}=KP_c^{'}
Puv=KPc′.