对于这么多月后仍然对此感兴趣的所有人,我已经设法使用 Kovesi 的代码(http://www.csse.uwa.edu.au/~pk/research/matlabfns)获得了正确的单应矩阵,并且特别是homography2d.m 函数。但是,您将需要装备四个角的像素值。如果相机是稳定固定的,那么您将需要这样做一次。请参见下面的示例代码:
%get corner pixel coords from base image
p1=[33;150;1];
p2=[316;136;1];
p3=[274;22;1];
p4=[63;34;1];
por=[p1 p2 p3 p4];
por=[0 1 0;1 0 0;0 0 1]*por; %swap x-y <--------------------
%calculate target image coordinates in world frame
% rig is 9x7 (X,Y) with 27.5mm box edges
XXw=[[0;0;0] [0;27.5*9;0] [27.5*7;27.5*9;0] [27.5*7;0;0]];
Rtarget=[0 1 0;1 0 0;0 0 -1]; %Rotation matrix of target camera (vertical pose)
XXc=Rtarget*XXw+Tc_ext*ones(1,4); %go from world frame to camera frame
xn=XXc./[XXc(3,:);XXc(3,:);XXc(3,:)]; %calculate normalized coords
xpp=KK*xn; %calculate target pixel coords
% get homography matrix from original to target image
HH=homography2d(por,xpp);
%do perspective transformation to validate homography
pnew=HH*por./[HH(3,:)*por;HH(3,:)*por;HH(3,:)*por];
这应该够了吧。请注意,Matlab 将图像中的 x 轴定义为行索引,将 y 定义为列。因此,必须在方程式中交换 xy(您可能会在上面的代码中看到)。此外,我已经设法仅从参数计算单应矩阵,但结果略有偏差(可能是校准工具箱中的舍入误差)。最好的方法是上面的。
如果只想使用相机参数(即不要使用 Kovesi 的代码),那么 Homography 矩阵为 H=KK*Rmat*inv_KK。在这种情况下,代码是,
% corner coords in pixels
p1=[33;150;1];
p2=[316;136;1];
p3=[274;22;1];
p4=[63;34;1];
pmat=[p1 p2 p3 p4];
pmat=[0 1 0;1 0 0;0 0 1]*pmat; %swap x-y
R=[0 1 0;1 0 0;0 0 1]; %rotation matrix of final camera pose
Rmat=Rc_ext'*R; %rotation from original pose to final pose
H=KK*Rmat*inv_KK; %homography matrix
pnew=H*pmat./[H(3,:)*pmat;H(3,:)*pmat;H(3,:)*pmat]; %do perspective transformation
H2=[0 1 0;-1 0 0;0 0 1]*H; %swap x-y in the homography matrix to apply in image