GPS计算例题资料.docVIP

例1 图为一简单GPS网，用两台GPS接收机观测，测得5条基线向量，，每一个基线向量中三个坐标差观测值相关，由于两台GPS接收机接收机观测，所以各观测基线向量相互独立，网中点其三维坐标已知，其余三个为待定点，参数个数。 图1 已知点信息（单位：m） LOC1-1974638.73404590014.81903953144.9235  编号起点终点基线方差阵1LOC2LOC1-1218.561-1039.2271737.7202LOC4LOC1270.457-5.3.2081879.9233LOC4LOC21489.013536.030142.2184LOC3LOC21405.531-178.1571171.3805LOC4LOC383.497714.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(1,3*k2-2)=XYZ(1,3*k1-2)+