Всем, кто все еще интересуется этим после стольких месяцев, мне удалось получить правильную матрицу гомографии, используя код Ковеси (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 в уравнениях (как вы, вероятно, увидите в приведенном выше коде). Кроме того, мне удалось вычислить матрицу гомографии только из параметров, но результат был немного отключен (возможно, ошибки округления в наборе инструментов калибровки). Лучший способ сделать это - выше.
Если вы хотите использовать только параметры камеры (то есть не используйтеКод Ковеси), то матрица гомографии будет 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