getimagepoint.m

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

function [firstPoint lastPoint]=getImagePoint(M,X,Y)
Z=0;
u=round((X*M(1,1)+ Y*M(1,2)+ Z*M(1,3) +M(1,4))/(X*M(3,1) +Y*M(3,2)+ Z*M(3,3)+ M(3,4)));
v=round((X*M(2,1)+Y*M(2,2)+ Z*M(2,3) +M(2,4))/(X*M(3,1)+ Y*M(3,2) +Z*M(3,3)+ M(3,4)));
firstPoint=[u,v];
x=(u-1024/2)/3.78;
y=(-v+768/2)/3.78;
lastPoint=[x,y];