eurec.m

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

%欧氏重构
%利用P186结论9.5计算H
clc
% x1=[vp111827 vp111287 vp114158 vp121827 vp121287 vp124158];
% [w]=fiveC(x1,6);
x1=[vp111827 vp111287 vp114158];
x2=[vp121827 vp121287 vp124158];
w=W(x1,x2);
B=inv(Hinf'*w*Hinf);

%Cholesky分解
[A]=chol(B)

H=[inv(A) zeros(3,1);
   zeros(1,3) 1];

%欧式重构的空间点XE
Xe1=H*Xa1;
Xe2=H*Xa2;
for i=1:8
    Xe1(1,i)=Xe1(1,i)/Xe1(4,i);
    Xe1(2,i)=Xe1(2,i)/Xe1(4,i);
    Xe1(3,i)=Xe1(3,i)/Xe1(4,i);
    Xe1(4,i)=1;
    Xe2(1,i)=Xe2(1,i)/Xe2(4,i);
    Xe2(2,i)=Xe2(2,i)/Xe2(4,i);
    Xe2(3,i)=Xe2(3,i)/Xe2(4,i);
    Xe2(4,i)=1;
end
figure
hold on
title('欧式重构结果');
XLABEL('X-axis')
YLABEL('Y-axis')
ZLABEL('Z-axis')
axis equal
grid
plotcube(Xe1,'b')
plotcube(Xe2,'r')
hold off