clc
%仿射重構
%根據三對消影點和一組對極點計算無窮遠單應Hinf
%從而仿射重構的攝像機可以取為P1=[I|0],P2=[Hinf|e2]
x1=[vp111827 vp111287 vp114158 e1];
x2=[vp211827 vp211287 vp214158 e2];
Hinf=H(x1,x2,2,4);
 
Pa1=[eye(3,3) zeros(3,1)];
Pa2=[Hinf e2];

for i=1:8
Xa1(:,i)=recon(Pa1,Pa2,x11(:,i),x21(:,i));
Xa2(:,i)=recon(Pa1,Pa2,x12(:,i),x22(:,i));
end
figure
hold on
title('仿射重構結果');
XLABEL('X-axis')
YLABEL('Y-axis')
ZLABEL('Z-axis')
% axis equal
grid
plotcube(Xa1,'b')
plotcube(Xa2,'r')
hold off