direct.m

用MATLAB实现模拟立方体的重构

%根据P188直接重构－利用地面知识
%给定五对地面控制点，直接重摄影重构跳到度量重构

clc
%摄影重构得到的五个点的坐标，每一列表示一个点，并且没有四个点共面
Xp=[Xp1(:,1) Xp2(:,2) Xp1(:,3) Xp2(:,5) Xp1(:,7)];
  
%地面控制点
Xe=[X1(:,1) X2(:,2) X1(:,3) X2(:,5) X1(:,7);
    1 1 1 1 1];


H=H(Xp,Xe,3,5);
% P1=P1*inv(H);
% P2=P2*inv(H);
% for i=1:8
% XE1(:,i)=recon(P1,P2,x11(:,i),x21(:,i));
% XE2(:,i)=recon(P1,P2,x12(:,i),x22(:,i));
% end

X=[Xp1 Xp2];
XE=H*X;
for i=1:16
    XE(1,i)=XE(1,i)/XE(4,i);
    XE(2,i)=XE(2,i)/XE(4,i);
    XE(3,i)=XE(3,i)/XE(4,i);
    XE(4,i)=1;
end
figure
hold on
title('直接欧氏重构结果');
XLABEL('X-axis')
YLABEL('Y-axis')
ZLABEL('Z-axis')
axis equal
grid
plotcube(XE(:,1:8),'b')
plotcube(XE(:,9:16),'r')

% plotcube(XE1,'b')
% plotcube(XE2,'r')
% hold off