GPS计算例题介绍.doc

例1 图为一简单GPS网，用两台GPS接收机观测，测得5条基线向量，，每一个基线向量中三个坐标差观测值相关，由于两台GPS接收机接收机观测，所以各观测基线向量相互独立，网中点其三维坐标已知，其余三个为待定点，参数个数。 图1 已知点信息（单位：m） LOC1 -1974638.7340 4590014.8190 3953144.9235  编号 起点 终点 基线方差阵 1 LOC2 LOC1 -1218.561 -1039.227 1737.720 2 LOC4 LOC1 270.457 -5.3.208 1879.923 3 LOC4 LOC2 1489.013 536.030 142.218 4 LOC3 LOC2 1405.531 -178.157 1171.380 5 LOC4 LOC3 83.497 714.153 -1029.199 编程代码： % 输入基线阵 [Filename pathName]=uigetfile({*.txt,Txt Files|*.txt},输入基线差); L=length(Filename); if L5 msgbox(wrong File,File open Error); end fid = fopen([pathName Filename]); %打开数据文件 tline1 = fgetl(fid); str = [-]?\d[\.]?\d*; f1=str2double(regexp(tline1,str,match)); m_Pnumber=f1(1,1);%总点数 m_knPnumber=f1(1,2);%已知点数 m_Lnumber=f1(1,3);%总的观测值 tline2= fgetl(fid); st = [\w][\w][\w][-]?\d[\.]?\d*; pname=regexp(tline2,st,match);%提取点名 [P1,P2,P3,P4,P5]=textread([pathName Filename],%s%s%s%s%s,headerlines,2); %输入基线方差阵 [Filename1 pathName1]=uigetfile({*.txt,Txt Files|*.txt},输入基线方差阵); L=length(Filename); if L5 msgbox(wrong File,File open Error); end a=textread([pathName1 Filename1]); for i=1:m_knPnumber %提取与已知点相关数据 pname1{i}=P1{i}; point2(i)=str2num(cell2mat(P2(i))); point3(i)=str2num(cell2mat(P3(i))); point4(i)=str2num(cell2mat(P4(i))); end XYZ=zeros(1,3*m_Pnumber);%命名点坐标大小 for i=1:m_knPnumber c=strmatch(pname1(i),pname);%将点名转换成点号 XYZ(1,3*c-2)=point2(i); XYZ(1,3*c-1)=point3(i); XYZ(1,3*c)=point4(i); end %将未知点的x坐标赋值为10^30 for i=1:(m_Pnumber-m_knPnumber) XYZ(1,3*(m_knPnumber+i)-2)=10^30; end for i=1:m_Lnumber dir1(i)=strmatch(P1(i+m_knPnumber),pname);%起点点号 dir2(i)=strmatch(P2(i+m_knPnumber),pname);%终点点号 XX(i)=str2num(cell2mat(P3(i+m_knPnumber)));%x坐标 YY(i)=str2num(cell2mat(P4(i+m_knPnumber)));%y坐标 ZZ(i)=str2num(cell2mat(P5(i+m_knPnumber)));%z坐标 end %计算未知点近似坐标 for i=1:m_Lnumber k1=dir1(i);%起点点号 k2=dir2(i);%终点点号 if XYZ(1,3*k1-2)=10^29 XYZ(1,3*k2-2)=10^29 %起点已知，终点未知 XYZ