Xs=sum(Xa)/4;
Ys=sum(Ya)/4;
Zs=sum(Za)/4;
x-x0=-f*[a1*(Xa-Xs)+b1*(Ya-Ys)+c1*(Za-Zs)]/[a3*(Xa-Xs)+b3*(Ya-Ys)+c3*(Za-Zs)];
y-y0=-f*[a2*(Xa-Xs)+b2*(Ya-Ys)+c2*(Za-Zs)]/[a3*(Xa-Xs)+b3*(Ya-Ys)+c3*(Za-Zs)];
x=-f*[a1*(Xa-Xs)+b1*(Ya-Ys)+c1*(Za-Zs)]/[a3*(Xa-Xs)+b3*(Ya-Ys)+c3*(Za-Zs)]+x0;
y=-f*[a2*(Xa-Xs)+b2*(Ya-Ys)+c2*(Za-Zs)]/[a3*(Xa-Xs)+b3*(Ya-Ys)+c3*(Za-Zs)]+y0;
%xyǼĽֵXaYaZa﷽﷽ռ
%x0,y0,fӰڷλԪ
%xӰ
x=[-86.15 -68.99;-53.40 82.21;-14.78 -76.63;10.46 64.43];
x0=0;
y0=0;
f=153.24;
for i=1:4
zi=[a3*(Xa(i,1)-Xs)+b3*(Ya(i,1)-Ys)+c3*(Za(i,1)-Zs)];
xi=-f*[a1*(Xa(i,1)-Xs)+b1*(Ya(i,1)-Ys)+c1*(Za(i,1)-Zs]/zi+x0;
yi=-f*[a2*(Xa(i,1)-Xs)+b2*(Ya(i,1)-Ys)+c2*(Za(i,1)-Zs]/zi+y0;
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=(yi-y0)*sin(b)-{(xi-x0)*[(xi-x0)*cos(c)-(yi-y0)*sin(c)]/f+f*cos(c)}*cos(b);
a15=-f*sin(c)-(xi-x0)*((xi-x0)*sin(c)+(yi-yo)*cos(c))/f;
a16=yi-y0;
a24=-(xi-x0)*sin(b)-{(yi-y0)*[(xi-x0)*cos(c)-(yi-y0)*sin(c)]/f-f*sin(c)}*cos(b);
a25=-f*cos(c)-(yi-y0)*((xi-x0)*sin(c)+(yi-yo)*cos(c))/f;
a26=-(xi-x0);
a17=(xi-x0)/f;
a18=1;
a19=0;
a27=(yi-y0)/f;
a28=0;
a29=1;
Ai=[a11 a12 a13 a14 a15 a16 a17 a18 a19
    a21 a22 a23 a24 a25 a26 a27 a28 a29];
Li=[x(i:1)-xi;y(i:2)-yi];
end
A=[A1;A2;A3;A4];
L=[L1;L2;L3;L4];

