张正友算法原理及其改进由于世界坐标系的位置可以任意选取,我们可以假定世界坐标系和摄像机坐标系重合,故定义模板平面落在世界坐标系的0WZ平面上
用ir 表示 R 的每一列向量,那么对平面上的每一点,有:123120111WWWWXuXYs vA rrrtA rrtY (3
1) 这样,在模板平面上的点和它的像点之间建立了一个单应性映射H ,又称单应性矩阵或投影矩阵
如果已知模板点的空间坐标和图像坐标,那么就已知 m和 M ,可以求解单应性矩阵H
)1,,(ww YX)1,,(vu因为11WWuXs vHY, 其中11121321222331321hhhHhhhhh, 可推出:11121321222331321WWWWWWsuh Xh Yhsvh Xh Yhsh Xh Y (3
2) 故,1112133132212223313211WWWWWWWWh Xh Yhuh Xh Yh Xh Yhvh Xh Y (3
3) 将分母乘到等式左边,即有31321112133132212223WWWWWWWWuX huY huh Xh YhvX hvY hvh Xh Yh (3
4) 又令Thhhhhhhhh3231232221131211,则10000001WWWWWWWWXYuXuYuhXYvXvYv (3
5) 多个对应点的方程叠加起来可以看成Shd
利用最小二乘法求解该方程,即1()TThS SS d ,进而得到 H
摄像机内部参数求解在求取单应性矩阵后, 我们进一步要求得摄像机的内参数
首先令ih 表示 H的每一列向量,需要注意到上述方法求得的H 和真正的单应性矩阵之间可能相差一个比例因子,则H 可写成:12312hhhA rrt (3
6) 又因为1r 和2r 是单位正交向量,所以有1210TTh AA h (3
7) 111122TTTTh AA hh AA h (3