برنامه Conformal

clc

clear

calib=input('enter calib matrix')

meas=input('enter meas matrix')

n=size(calib,2)/2

l=calib'

syms a b cx cy

for k=1:2:2*n

    x=a*meas(1,k)+b*meas(1,k+1)+cx

    y=-b*meas(1,k)+a*meas(1,k+1)+cy

   A(k,:)=jacobian(x,[a b cx cy])

    A(k+1,:)=jacobian(y,[a b cx cy])

end

A=eval(A)

xcap=inv(A'*A)*(A'*l)

r=l-(A*xcap)