GPS算法考试重点整理2.docVIP

演示程序6： （CalMain.m） clear all%清除内存变量和函数 close all%关闭所有窗口 clc%清楚指令窗 format long %精度变长 mpmat=mpgen(230,3600,1,54321);%产生随机矩阵 usrllh = [39.53*pi/180 151.1*pi/180 0];%定义用户位置 纬度 经度 高 usrxyz = llh2xyz(usrllh); %转换为wgs84坐标 loadgps; %加载GNSS星座 randn(state,9083247);%产生随机数 TotalVDOP=[];%变量 for t=15000:16000; %给定历元 [svxyzmat,svid] = gensv(usrxyz,t,15); %产生限定条件下的可见卫星位置及卫星编号 [prvec,adrvec] = genrng(1,usrxyz,svxyzmat,svid,t,[1 1 0 1 1],[],mpmat); %模拟伪距及伪速率 [estusr,H]= olspos(prvec,svxyzmat);%计算用户位置和钟差改正数和方向余弦矩阵 % start DOP value calculation %空间直角坐标转换大地坐标 lat = usrllh(1);%用户纬度 lon = usrllh(2);%用户经度 Rt = []; Rt(1,1) = -sin(lon); Rt(1,2) = cos(lon); Rt(1,3) = 0; Rt(2,1) = -sin(lat) * cos(lon); Rt(2,2) = -sin(lat) * sin(lon); Rt(2,3) = cos(lat); Rt(3,1) = cos(lat) * cos(lon); Rt(3,2) = cos(lat) * sin(lon); Rt(3,3) = sin(lat); %计算协因素阵 N = inv(H*H);%协因数阵Qxx N = N(1:3,1:3);%取前三行前三列 N = Rt * N * Rt;%计算特定方向Qxx PDOP = sqrt(N(1,1) + N(2,2) + N(3,3));%空间位置精度因子 HDOP = sqrt(N(1,1) + N(2,2));%平面位置精度因子 VDOP = sqrt(N(3,3));%高程精度因子 TotalVDOP=[TotalVDOP VDOP];%存储每秒位置精度因子的矩阵 end plot(TotalVDOP,-*)%绘图 title(GPS DOP VALUE CALCULATION)%标题 ylabel(VDOP value)%y轴标签 xlabel(TIME (S))%x轴标签 disp(user position)%输出 estusr (hmat.m) function h = hmat(svmat,usrpos) %HMAT Compute Direction Cosine Matrix % % h = hmat(svmat,usrpos) % % INPUTS % svmat = matrix of satellite positions in % user defined cartesian coordinates % svmat(i,1:3) = x,y,z coordinates for satellite i % usrpos = estimated user position in user defined % cartesian coordinates % % OUTPUTS % h = direction cosine matrix for GPS positioning % Reference: %