MATLAB前方交会函数程序

function coordinate = qianfangjiaohui（xdzbwfwysflA）
%前方交会-点投影系数法
%输入像点坐标以及左右像片外方位元素焦距fl和转交A计算得到c
%像点坐标xdzb=[xlylxryr];coordinate=[X Y Z];
%wfwys=[XlYlZlfailomilkal;XrYrZrfairomirkar]
xo=0;yo=0;
[mn]=size（xdzb）;
Bx=-wfwys（11）+wfwys（21）;By=-wfwys（12）+wfwys（22）;Bz=-wfwys（13）+wfwys（23）;
a1l=cos（wfwys（14））*cos（wfwys（16））-sin（wfwys（14））*sin（wfwys（15））*sin（wfwys（16））;
a1r=cos（wfwys（24））*cos（wfwys（26））-sin（wfwys（24））*sin（wfwys（25））*sin（wfwys（26））;
a2l=-cos（wfwys（14））*sin（wfwys（16））-sin（wfwys（14））*sin（wfwys（15））*cos（wfwys（16））;
a2r=-cos（wfwys（24））*sin（wfwys（26））-sin（wfwys（24））*sin（wfwys（25））*cos（wfwys（26））;
a3l=-sin（wfwys（14））*cos（wfwys（15））;
a3r=-sin（wfwys（24））*cos（wfwys（25））;
b1l=cos（wfwys（15））*sin（wfwys（16））;b2l=cos（wfwys（15））*cos（wfwys（16））;b3l=-sin（wfwys（15））;
b1r=cos（wfwys（25））*sin（wfwys（26））;b2r=cos（wfwys（25））*cos（wfwys（26））;b3r=-sin（wfwys（25））;
c1l=sin（wfwys（14））*cos（wfwys（16））+cos（wfwys（14））*sin（wfwys（15））*sin（wfwys（16））;
c1r=sin（wfwys（24））*cos（wfwys（26））+cos（wfwys（24））*sin（wfwys（25）