张氏标定法原理及其改进1

《张氏标定法原理及其改进1》由会员分享，可在线阅读，更多相关《张氏标定法原理及其改进1（10页珍藏版）》请在金锄头文库上搜索。

1、张正友算法原理及其改进由于世界坐标系的位置可以任意选取，我们可以假定世界坐标系和摄像机坐标系重合，故定义模板平面落在世界坐标系的 平面上。用 表示 的0WZirR每一列向量，那么对平面上的每一点，有：(3.1)123120WWXu XYsvArtArtY 这样，在模板平面上的点和它的像点之间建立了一个单应性映射 ，又称H单应性矩阵或投影矩阵。如果已知模板点的空间坐标和图像坐标，那么就已知和 ，可以求解单应性矩阵 。mMH)1,(wYX,(vu因为 ,其中 ,可推出：1WuXsvY2313h(3.2)1122333WsYvhhX故，(3.3)112332132WYuhhvX将分母乘到等式左边，即

2、有(3.4)313211232WWuhYuYvvhh又令 ，则 T32131312(3.5)00WWWXuXuYvYv 多个对应点的方程叠加起来可以看成 。利用最小二乘法求解该方程，Shd即 ，进而得到 H。1()ThSd摄像机内部参数求解在求取单应性矩阵后，我们进一步要求得摄像机的内参数。首先令 表示ih的每一列向量，需要注意到上述方法求得的 和真正的单应性矩阵之间可能H相差一个比例因子，则 可写成： (3.6)12312hArt又因为 和 是单位正交向量，所以有1r2(3.7)120T(3.8)112Thh这样就为内参数的求解提供了两个约束方程。下面，令12133 0222022000 0

3、22211TBAvuvuvuvu v 注意到 是一个对称矩阵，所以它可以由一个 6 维向量来定义，即B(3.9)121323TbBB设 的第 列向量为 ，因此有Hi 3,Tiiih(3.10)TijijVb其中，那么，11212313233,TijijijijijijijijijijVhhhhh 就可以将内参数的两个约束写成关于 的两个方程为：b(3.11)120TV如果有 幅图像的话，把它们的方程式叠加起来，得到n(3.12)b其中， 是一个 的矩阵。当 时，一般情况下， 可以在相差一V263nb个尺度因子的意义下唯一确定；当 时，此时的方程的个数少于未知数的个2数，我们可以加上一个附加约束

4、 ，即 ，因此可用01B作为式(3.12)的一个附加方程。方程(3.12)的最小二乘010b解即是 的最小特征值对应的特征向量，将该向量归一化即得到要求的 ，TV b进而得到 ；当 时，两个方程只能解两个未知数，我们可以假定光心投影B1n在图像的中心，从而求出摄像机在水平和垂直方向上的最大倍数。一旦 被求出，就能根据下面两种方法计算出摄像机的内参数矩阵 ：b A(1)由 构造出 ，再利用 Cholesky 矩阵分解算法求解出 ，再求逆得到bB1A。A(2) 由 构造出 ，在相差一个尺度因子的意义下( ,其中为1TB尺度因子) ,由绝对二次曲线的性质，很容易求出摄像机的内部参数：20123123

5、11()/)v03(/BvB1/xf 21()y21/xyf2013xuvBf摄像机外部参数求解由每幅图像的单应性矩阵 和上一节的计算结果就可以求得每幅图像的外H部参数。一旦 A 求得后，根据式(3.6)，每幅图像的外部参数很容易求出：1rh122rAh312r13tAh这里的尺度因子 。当然，由于图像必然有噪声，因2/此这样解得的 并不能完全满足旋转矩阵的性质，所以要从一个给定123,R的矩阵求解一个最佳的旋转矩阵。非线性优化（优化内参）以上我们所得到的摄像机的内参数矩阵和每幅图像对应的外参数矩阵都只是一个粗糙解，没有具体的物理意义，可以通过最大似然估计对所有参数进行非线性优化，进一步求精。

6、在这里可以假定有 幅关于模板平面的图像，模板n平面上有 个标定点，那么可建立评价函数：m(3.13)21,nmijijijCARtM其中 是第 幅图像中的第 个像点， 是第 幅图坐标系的旋转矩阵，ij i是第 幅图坐标系的平移向量， 是第 个点的空间坐标， 是it j ,ijmARtM通过这些已知量求得的像点坐标。由于旋转矩阵有 9 个参量但是只有三个自由度，因此可用三个参量的矢量来表示，即一个旋转可由一个三维向量即旋转向量来表示，他的方向就是旋转轴的方向，他的模等于旋转角。由三个欧拉角参数确定， 是旋转矩阵的罗德里克(Rodrigues)表123(,)Tr示， 与 之间的关系由公式给出：Rr

7、(3.14)2sin/(cos)/xxRI r其中，旋转向量 ，定义由它构成的反对称矩阵为Tzyxr),(，0xyzrx其中 是旋转角。|22zyx使评价函数最小的 就是这个问题的最优解。这是一个经典的非线,ijARtM性最小二乘问题，对式(3.13)求极小值仍采用 Levenberg-Marquardt 算法来求解，其初始估计可利用上面线性求解的结果。很明显可以看出，计算顺序依次是投影矩阵、内部参数、外部参数，最后进行优化。对径向畸变处理(u,v)理想像素坐标， 为实际的像素坐标，同样(x,y)和 为理想和实),(vu ),(yx际的图像坐标。 )()(2221yxkyxkyx其中， 为径向

8、畸变，对于中心点畸变同样适用：21,k)()()( 22210 yxkyxkvu可以通过下面的方法求解畸变系数： vukyxvyxvu 212020 )()(高斯一牛顿方法优化：可以利用极大似然估计来得到畸变系数： 2121|),(|nimj jiij MtRkA非线性优化的过程：采用高斯一牛顿方法，而没有用 Levenberg 一 Marquardt(LM)法是因为在实际应用中发现，如果没有先验知识，LM 法阻尼因子 u 不知道去什么值合适，而随意的取值使得方程在求解时收烟速度慢。而高斯一牛顿法在求解的附近一般收敛速度快，虽然对初始值要求严格，当初始值与实际值偏离的太远，其系数阵 JTJ 容

9、易出现病态解，但是，所以参数的初始值必须要做优化。这里 是点 按照投影公式在第 i 幅图片上的投影，K),(jicMTRKmj是摄像机标定内参数矩阵， 是畸变系数矩阵， 、 是第 i 副图像的外参数c iRiT矩阵，其中 R 通过 Rodrigues 公式用三个参数的旋转向量 r 来表达。优化的步骤：(1)、首先确定目标函数。这里的优化的目的是使优化后的外参数，按照本文建立的摄像机模型将空间点投影到图像平面上时，投影点与实际获取的图像控制点之间的残差平方和最小。不妨设投影函数为其中 K 是摄像机内参数矩阵， 是畸变系数矩阵，是旋转向量，T 是平移矩阵， 是模板平面上控制点 的坐标。 是投影点图

10、像像素坐标，该点实际的图像坐标是iM，共 n 个控制点。要优化外参数，则最后需要的偏导数系数 Jacobian 矩阵 和rmi/得组合，而函数 )显然是个复合函数，因此这实际上是Tmi/个复合函数求偏导的问题。下面针对第一次迭代即 r=r0、T=T 0 为初值时的一个点 来分步求解第一步，是 r 与 R 的转换。由 Rodrigues 公式可以求出.第二步，是世界坐标系到摄像机坐标系的转换。由坐标转换公式求出摄像机坐标系下的坐标及相应偏导数系数阵：这里偏导数矩阵中的下标 i 表示求出偏导数矩阵后，再将当前点(即第 i 点)各相应坐标代入以求得偏导数系数矩阵。同时可以看出，若直接以 R 为参量，

11、因为复合函数求偏导是偏导矩阵相乘的关系，则由于 是 3*9 矩阵而 。第三步，将厉 转化为归一化图像坐标。设 的归一化图像坐标为 ，ciMciMniM可得 的计算公式及其偏导数系数阵：ni注意：表示 qxp 系数矩阵 B 将与矩阵 A 中的所有分块矩阵 (i=1,2,n,j=1,2,m)均ijA相乘，其中分块矩阵 (i=1,2,n,j=1,2,m)的行数等于系数矩阵 B 的列数 p。ij第四步，计算考虑有图像畸变的归一化图像坐标。设 ，则含有畸变的归一化图像坐标和偏导数系数阵可由归一化公式(4.38)式来计算(4.39)(4.40)：对畸变系数的优化： 42ryxKmnncd第五步，求迭代计算

12、出的投影点图像像素坐标 和偏导数系数阵，按照(4.18)式进行计算：vundfm0)(cndcK若是对内部参数的优化为： 100ndndyxKm优化外部参数：优化全局参数： 0,|,Trici mKJ第六步，求第一次迭代产生的偏差，并由式： iTJ1)(计算参数迭代增量，为下一次迭代做准备。iiim改进的方法具体介绍(1)、改进的平面模板两步法标定摄像机毛剑飞，邹细勇，诸静该方法张正友提出用平面模板两步法来标定摄像机。该方法能高精度地标定摄像机，且简便易行，可以说是两步法标定的代表，但其算法模型仅考虑了镜头径向畸变，其对切向畸变较大的场合，如鱼眼镜头成像，则不适用。为此，通过改进其摄像机模型，

13、提出了一种改进的两步法，该方法先用图像中心附近点求取初值，由于图像中心附近点畸变很小，故求取的初值能很好地逼近准确值，然后采用一种基于内部映射牛顿法的子空间置信域法通过求精来得到所有参数。由于两步法要求一个比较好的初值，若初值选择不当，则算法难以收敛或只能收敛到局部最小，从而大大降低标定精度。zhang 的方法缺点在求取初值中，虽先不考虑各种畸变，而是先将所有点代入求解，但由于远离图像中心的像点畸变很大，如将这些点也看作没有畸变的像点代入，显然会加大求解初值的误差，但由于考虑到图像中心附近点的畸变很小，因此可以先利用图像中心附近点求取初值。本文算法正是基于这点考虑的，由于本文算法准确地计算了初

14、值，因此接下来的全面考虑各参数的非线性最小化计算就能很快收敛。仿真摄像机的特性：分辨率为 768576 像素，真实实验使用三星 SCC-421P 型彩色摄像机，分辨率为 576768，模板是用激光打印机打印710 的国际象棋图案，并贴在硬塑料板上制成的标定模板，每格边长 2.5000cm。因为整个包括角点检测的标定程序已经编好，所以只要让模板对着摄像机随意转动几次，即可完成标定，时间不到 10 s。用本文提出的模型和算法进行标定,其结果如表 1、表 2 所示。表中 S 表示重建后的图像点与实际图像点的平均距离，其是将内外参数代入优化模型计算后求平均得出的，由于利用优化模型式也可求出 (S), 所以 S 和 (S) 表示了算法的收敛效果。表 2重建图像点后的误差对比总结：实际的测量的角点像素坐标，与矫正后的角点像素的坐标的差值。从上述的数据VU,_可以看出这两个数据是很接近的。重建后的图像点误差分布很均匀，其图像点的总体平均误差为 0。相比张正友的算法，精度有一定得提高。总的来说，这种方法在张正友的方法上添加一个从中间取点算初值（默认为中间的点的畸变量小） ，对精度有一定的提高。 （由借鉴的方面）