a=0
b=0
c=0
Xa=[36589.41;37631.08;39100.97;40426.54]
Ya=[25273.32;31324.51;24934.98;30319.81]
Za=[2195.17;728.69;2386.50;757.31]
Xs=sum（Xa）/4
Ys=sum（Ya）/4
Zs=7000
H=[Xs?Ys?Zs?0?0?0?]
xx=[-86.15?-68.99;-53.40?82.21;-14.78?-76.63;10.46?64.43]/1000
x0=0
y0=0
f=153.24/1000
for?j=1:1000
????Xs=H（1）;Ys=H（2）;Zs=H（3）;a=H（4）;b=H（5）;c=H（6）;
????
for?i=1:4
a1=cos（a）*cos（c）-sin（a）*sin（b）*sin（c）
a2=-cos（a）*sin（c）-sin（a）*sin（b）*cos（c）
a3=-sin（a）*cos（b）
b1=cos（b）*sin（c）
b2=cos（b）*cos（c）
b3=-sin（b）
c1=sin（a）*cos（c）+cos（a）*sin（b）*sin（c）
c2=-sin（a）*sin（c）+cos（a）*sin（b）*cos（c）
c3=cos（a）*cos（b）
R=[a1?a2?a3;b1?b2?b3;c1?c2?c3]
z（i）=（a3*（Xa（i1）-Xs）+b3*（Ya（i1）-Ys）+c3*（Za（i1）-Zs））
x（i）=-f*（a1*（Xa（i1）-Xs）+b1*（Ya（i1）-Ys）+c1*（Za（i1）-Zs））/z（i）
y（i）=-f*（a2*（Xa（i1）-Xs）+b2*（Ya（i1）-Ys）+c2*（Za（i1）-Zs））/z（i）
a11=（a1*f+a3*（xx（i1）-x0））/z（i）
a12=（b1*f+b3*（xx（i1）-x0））/z（i）
a13=（c1*f+c3*（xx（i1）-x0））/z（i）
a21=（a2*f+a3*（xx（i2）-y0））/z（i）
a22=（b2*f+b3*（xx（i2）-y0））/z（i）
a23=（c2*f+c3*（xx（i2）-y0））/z（i）
a14=（xx（i2）-y0）*sin（b）-（???（xx（i1）-x0）*??（（xx（i1）-x0）*cos（c）-（xx（i2）-y0）*sin（c））?/f+??f*cos（c）???）*cos（b）
a15=-f*sin（c）-（xx（i1）-x0）*?（（xx（i1）-x0）*sin（c）+（xx（i2）-y0）*cos（c））?/f
a16=xx（i2）-y0
a24=-（xx（i1）-x0）*sin（b）-（（xx（i2）-y0）*（（xx（i1）-x0）*cos（c）-（xx（i2）-y0）*sin（c））/f-f*sin（c））*cos（b）
a25=-f*cos（c）-（xx（i2）-y0）*（（xx（i1）-x0）*sin（c）+（xx（i2）-y0）*cos（c））/f
a26=-（xx（i1）-x0）

A（2*i-1:2*i1:6）=[a11?a12?a13?a14?a15?a16;a21?a22?a23?a24?a25?a26]

L（2*i-1:2*i）=[xx（i1）-x（i）;xx（i2）-y（i）]
end

X=inv（A‘*A）*A‘*L‘;
V=A*X-L‘;
H=H+X‘

if?max（abs（X））<0.1
????H
????R
????break;
end
end

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----

?????文件???????2755??2010-01-02?22:30??攝影測量編程\攝影\1.txt

?????文件??????47104??2006-11-21?22:01??攝影測量編程\攝影\判讀\dtyyg（1）.doc

?????文件??????47104??2006-11-21?22:01??攝影測量編程\攝影\判讀\dtyyg.doc

?????文件????2569803??2007-05-02?11:37??攝影測量編程\攝影\判讀\practice2.doc

?????文件?????150016??2008-07-01?12:41??攝影測量編程\攝影\判讀\syzd（1）.doc

?????文件?????150016??2008-07-01?12:41??攝影測量編程\攝影\判讀\syzd.doc

?????文件??????10752??2010-01-02?14:08??攝影測量編程\攝影\判讀\新建?Microsoft?Word?文檔.doc

?????文件??????????0??2010-01-02?14:45??攝影測量編程\攝影\判讀\新建?文本文檔.txt

?????文件?????624642??2009-12-29?16:35??攝影測量編程\攝影\復(fù)件?攝影.doc

?????文件?????238080??2009-12-29?12:42??攝影測量編程\攝影\復(fù)件?攝影測量實習(xí)作業(yè).doc

?????文件????????917??2009-12-31?11:33??攝影測量編程\攝影\復(fù)件?新建?文本文檔?（4）.txt

?????文件????????723??2009-12-30?15:47??攝影測量編程\攝影\復(fù)件?新建?文本文檔.txt

?????文件?????624642??2009-12-29?16:35??攝影測量編程\攝影\攝影.doc

?????文件?????604378??2010-01-02?22:32??攝影測量編程\攝影\攝影.rar

?????文件?????782336??2010-01-04?22:59??攝影測量編程\攝影\攝影實習(xí).doc

?????文件?????227840??2010-01-03?13:34??攝影測量編程\攝影\攝影測量實習(xí)作業(yè).doc

?????文件???????1634??2009-11-04?14:20??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\sheyingceliang1.m

?????文件?????????37??2009-11-03?00:44??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\X矩陣.txt

?????文件???????1434??2009-11-03?17:23??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\像空間坐標(biāo).txt

?????文件???????1415??2009-11-03?23:00??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\攝影測量原程序.txt

?????文件???????1949??2009-09-29?16:49??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\新建?文本文檔?（2）.txt

?????文件????????281??2009-09-29?17:06??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\新建?文本文檔?（3）.txt

?????文件????????609??2009-10-14?14:00??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\新建?文本文檔.txt

?????文件???????1634??2009-11-04?14:23??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\最新更新.txt

?????文件????????633??2009-11-03?16:53??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\求A矩陣.txt

?????文件?????????43??2009-11-03?17:06??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\求L矩陣.txt

?????文件????????268??2009-11-02?23:47??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\分塊解決\求旋轉(zhuǎn)矩陣.txt

?????文件???????1634??2009-11-04?14:20??攝影測量編程\攝影\攝影測量編程\攝影測量程序1\攝影測量1.txt

?????文件???????1283??2009-11-12?12:29??攝影測量編程\攝影\攝影測量編程\攝影測量程序2\Moravec.m

?????文件???????1203??2009-11-12?12:25??攝影測量編程\攝影\攝影測量編程\攝影測量程序2\攝影測量實驗二.txt

............此處省略42個文件信息