a11=(a1*f+a3*(xi-x0))/zi;
a12=(b1*f+b3*(xi-x0))/zi;
a13=(c1*f+c3*(xi-x0))/zi;
a21=(a2*f+a3*(yi-y0))/zi;
a22=(b2*f+b3*(yi-y0))/zi;
a23=(c2*f+c3*(yi-y0))/zi;
a14=(y-y0)*sin(b)-(((x-x0)*((x-x0)*cos(c)-(y-y0)*sin(c))/f+f*cos(c))*cos(b);
a15=-f*sin(c)-(x-x0)*((x-x0)*sin(c)+(y-yo)*cos(c))/f;
a16=y-y0;
a24=-(x-x0)*sin(b)-(((y-y0)*((x-x0)*cos(c)-(y-y0)*sin(c))/f-f*sin(c))*cos(b);
a25=-f*cos(c)-(y-y0)*((x-x0)*sin(c)+(y-yo)*cos(c))/f;
a26=-(x-x0);
a17=(x-x0)/f;
a18=1;
a19=0;
a27=(y-y0)/f;
a28=0;
a29=1;
for i=1:4;
Ai=[a11 a12 a13 a14 a15 a16 a17 a18 a19
    a21 a22 a23 a24 a25 a26 a27 a28 a29];
end
A=[A1 A2 A3 A4]'