http://blog.csdn.net/aptx704610875/article/details/48914043标定实例算法
一.整体原理:数组
摄像机标定(Camera calibration)简单来讲是从世界坐标系换到图像坐标系的过程,也就是求最终的投影矩阵的过程。性能
[1]基本的坐标系:atom
[2]通常来讲,标定的过程分为两个部分:spa
二.基本知识介绍及.net
一、摄像机模型3d
camera centre
,即相机的中心点,也是相机坐标系的中心点;
principal axis
,即相机的主轴;
image plane
,即相机的像平面,也就是图片坐标系所在的二维平面;
principal point
,即主点,主轴与像平面相交的点;
m
);
m
);
pixel
);
采用理想针孔模型,因为经过针孔的光线少,摄像机曝光太慢,在实际使用中均采用透镜,可使图像生成迅速,但代价是引入了畸变。code
有两种畸变对投影图像影响较大: 径向畸变和切向畸变。blog
xcorrected = x(1+k1r2+k2r4+k3r6)图片
ycorrected = y(1+k1r2+k2r4+k3r6)
这里(x, y)是畸变点在成像仪上的原始位置,r为该点距离成像仪中心的距离,(xcorrected ,ycorrected )是校订后的新位置。
对于通常的摄像机校订,一般使用泰勒级数中的前两项k1和k2就够了;对畸变很大的摄像机,好比鱼眼透镜,可使用第三径向畸变项k3
二、切向畸变
旋转向量(大小为1×3的矢量或旋转矩阵3×3)和平移向量(tx,ty,tz)。
旋转向量:旋转向量是旋转矩阵紧凑的变现形式,旋转向量为1×3的行矢量。
r就是旋转向量,旋转向量的方向是旋转轴 ,旋转向量的模为围绕旋转轴旋转的角度。
经过上面的公式,咱们就能够求解出旋转矩阵R。一样的已知旋转矩阵,咱们也能够经过下面的公式求解获得旋转向量:
七.标定内幕过程的分析:
1.假设有N个角点和K个棋盘图像(不一样位置),须要多少个视场和角点才能提供足够的约束来求解这些参数呢?
K个棋盘,能够提供2NK的约束,即2NK的方程。(乘以2是由于每一个点都由x和y两个坐标值组成)
忽略每次的畸变,那么咱们须要求解4个内参数和6K个外参数。(由于对于不一样的视场,6个外参数是不一样的)
那么有解的前提是方程的总数应该大于等于未知参数的总数即2NK>=6K+4,或者写成(N-3)K>=2。
为了方便理解,下图是一个3×3大小的棋盘,红色圈标记出了它含有的内角点:
若是咱们令N=5,K=1,带入到上述不等式,是知足不等式,这就是意味着咱们仅须要一个视场和带有5个内角点的棋盘就能够求解出10个参数了。其实否则,为了描述投影视场的全部目标只须要4个点,即一次性在四个方向上延展正方形的边,把它变成任意四边形。所以,不管一个平面上检测到多少个角点,咱们只能获得4个有用的角点信息。如上图所示是一个3×3大小的棋盘,有4个内角点。对于每个视场,咱们仅能给出4个有用的角点信息,那么上述的公式中N就约束为4,即公式变为(4-3)K>=2,即K>=2。即要求解10个参数最少须要两个视场。考虑到噪声和数值稳定性要求,对大棋盘需求收集更多的图像。为了获得高质量结果,至少须要10幅7×8或者更大棋盘的图像(并且只在移动棋盘在不一样图像中足够大以从视场图像中获得更加丰富的信息)。
2.数学是怎么应用于标定的?
OpenCV选着那些可以很好工做于平面物体的方法。OpenCV中使用的求解焦距和偏移的算法是基于张的方法,但求解畸变参数则是另一个基于Brown的方法。
(1)首先咱们假定求解标定参数时,摄像机没有畸变。对于每个棋盘视场,咱们获得一个前面描述的单应性矩阵H,大小为3×3。将H写成列向量的形式,即H=[h1 h2 h3],每一个h是3×1向量,单应性矩阵H是物理变换(旋转、平移)和相机内参数组成。咱们的目的就是分解这个H,可以从中分解出这些成分。
M是摄像机内参数矩阵,r1,r2是旋转矢量3×1,t是平移矢量,缩放因子s,对应项相等获得以下:
λ=1/s
咱们知道R=[r1,r2,r3],r3消失,是由于咱们另Z=0。R是一个正交阵,即R的转置等于R的逆。正交阵的每一个列向量是两两正交且单位化的(即模为1),那么r1和r2是相互正交。
正交的含义有两个:两个矢量的点积为0,两个矢量的长度相等。下面咱们就用这两个约束来进行求解。
咱们将r1和r2带入到上述的公式得:
令:
展开有:
其中M公式以下:
(注意:这里的cx、Cy至关于上面的U0、V0)
将M带入公式,能够获得矩阵B的通用形式的封闭解:
这里从新写一下两个约束:
因为B是对称真,那么B能够仅有对角线下半元素或者对角线上半元素表示,便可以有6个元素表示。咱们将通用形式展开,而且提取出B成分,那么通用形式能够写成含有旋转成分和含有B成分的6个元素组成的向量的点积(注意:是点积,不是两个矩阵相乘),以下:
从上述公式,咱们已知单应性矩阵H,那么它其中的每个元素咱们都是已知的,那么上述Bij是咱们要求解的值,
咱们能够组合两个约束为以下的形式:
每个视场咱们能够获得形如上面描述的2个公式(上述黄色部分),那么对于K的视场,咱们能够获得2K个这样的公式。
咱们堆积这些方程有:
b是要求解未知数矢量大小为6×1,V是2K×6的矩阵,若是K>=2,那么方程有解b=[B11,B12,B22,B13,B23,B33]T。摄像机内参数能够从B矩阵的封闭解中直接获得:
外参数(旋转和平移)能够由单应性条件计算获得:
上述公式中,λ,M,H,都是求解的获得的做为已知量,(r3=r1×r2,这是由于r1,r2,r3两两正交)。
须要当心的是,当咱们使用真实的数据求解时,将计算获得的r向量放在一块儿(R=(r1,r2,r3)),咱们并不能获得精确的旋转矩阵R,使得R为正交阵。
为了解决这个问题,咱们常使用强制的方法,即对R进行奇异值分解,R=UDVT,U,V为正交阵,D为对角阵,若是R是正交阵,那么奇异值分解后的对角阵D是单位阵,那么咱们将单位阵I代替对角阵D,进而重构出知足正交条件的R.
(2)在前面的工做中,咱们老是先忽略透镜畸变,而后求解获得的系统。若是针孔模型是完美的,令(xp,yp)为点的位置,令(xd,yd)为畸变的位置,那么有:
经过下面的替换,能够获得没有畸变的标定结果:
就像先前描述的那样,上述5个畸变参数:k1,k2,k3,p1,p2,须要3个角点构成的6组方程就能够求解。咱们猜想一下,咱们经过前面的计算已经求解出相机的内参数:fx,fy,cx,cy,棋盘平面上角点的坐标为世界坐标,其中X,Y咱们能够理解为在其平面上的坐标,Z是一个尺度,由于咱们知道求解单应性矩阵H,也是一个尺度,因此具体怎么控制,先不用管,咱们就能够经过上述公式一求解出xp和yp,xd,yd就是成像仪上角点的真实位置,那么就能够由xp,yp和xd,yd的点对,带入到上述的公式二,求能够求解出5个畸变系数。