getobjectpoint.m

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

function Point=getObjectPoint(M,u,v)
Z=0;
a=-(Z*M(1,3) +M(1,4)-(Z*M(3,3)+ M(3,4))*u);
b=-(Z*M(2,3) +M(2,4)-(Z*M(3,3)+ M(3,4))*v);
P=[M(1,1)-u*M(3,1) M(1,2)-u*M(3,2);M(2,1)-v*M(3,1) M(2,2)-v*M(3,2)]\[a;b];
Point=[round(P(1)),round(P(2))];