clc;clear all

calib=input('enter calib information');

meas=input('enter measurment coordinate');

m=size(calib,2)/2

l=(calib')

for k=1:2:2m

    a(k,1)=meas(1,k);

    a(k,2)=meas(1,k+1);

    a(k,5)=1;

    a(k+1,3)=meas(1,k);

    a(k+1,4)=meas(1,k+1);

    a(k+1,6)=1;

end

XCAP=inv((a')*a)*((a')*(l));

R=l-(a*XCAP);

r=R*1000