affrec.m

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

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