getm.m

这是我们组参加2008年全国大学生数学建模时A题(数码相机定位)所用到得程序

function M=getM %I(Image)-代表像，O(Object)代表物
                %可在这里随意改变I、O的值，进而获取不同的结果
O=[42 0;112 0;0 12;0 112;100 12;100 112;12 24];
I=[157 429;176 653;182 282;500 246;210 604;501 549;231 316];

[r,c]=size(I);
Z=0;
K=[];
U=[];
for i=1:r 
    A=[O(i,1) O(i,2) Z 1 0 0 0 0 -I(i,2)*O(i,1) -I(i,2)*O(i,2) -I(i,2)*Z
        0 0 0 0 O(i,1) O(i,2) Z 1 -I(i,1)*O(i,1) -I(i,1)*O(i,2) -I(i,1)*Z*O(i,1)]; 
    K=[K;A];
    B=[I(i,2);I(i,1)];
    U=[U;B];
end
%m=K\U;
m= pinv(K'*K)*K'*U;
m=[m;1];
m=m';
M=[m(1:4);m(5:8);m(9:12)];