資源簡介
自己整理了下一些前方交會的算法。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)
- 上一篇:SAR C矩陣轉T矩陣
- 下一篇:視頻分幀matlab
評論
共有 條評論