prorec.m

来自「用MATLAB实现模拟立方体的重构」· M 代码 · 共 33 行

%摄影重构3D空间的点
%已知基本矩阵和两幅图象上m个的点Im1,Im2,每一列为一个点
%返回空间点的坐标

clc

%  求摄像机矩阵P1,P2

Pp1=[eye(3,3) zeros(3,1)];
E2=[0 -e2(3) e2(2);
    e2(3) 0 -e2(1);
    -e2(2) e2(1) 0];
Pp2=[E2*F e2];
% [X,Y,Z]=triangle(Im1,Im2,P1,P2,16);
% Xp1=[X(1:8);Y(1:8);Z(1:8)];
% Xp2=[X(9:16);Y(9:16);Z(9:16)];
for i=1:8
Xp1(:,i)=recon(Pp1,Pp2,x11(:,i),x21(:,i));
Xp2(:,i)=recon(Pp1,Pp2,x12(:,i),x22(:,i));
end
figure
hold on
title('摄影重构结果');
XLABEL('X-axis')
YLABEL('Y-axis')
ZLABEL('Z-axis')
axis equal
grid
plotcube(Xp1,'b')
plotcube(Xp2,'r')
hold off