recon.m

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

function Xrecon=recon(p1,p2,v1,v2)

%由两幅图象上的一对对应点和摄影矩阵构建三维空间点
%p1,p2为两摄像机矩阵，v1,v2为两图象上的对应点坐标
%函数具体原理参见笔记

A=[p1 v1 zeros(3,1);p2 zeros(3,1) v2];
[U,D,V]=svd(A);    
v=V(:,6);
temp=[v(1,:)/v(4,:);v(2,:)/v(4,:);v(3,:)/v(4,:);1];
Xrecon=temp;