基于MATLAB的GNSS单点定位解算

1、间接平差原理：

2.代码部分

%已知伪距观测值，卫星坐标
%GNSS单点定位解算
%已知X,Y,Z卫星坐标，和伪距P
P=[24115224.586,23852690.710,22389912.802,24577319.825,23384340.177,24479081.841]';
X=[4791839.793 ,24513555.750 ,14424694.880 ,2438267.619 ,24699645.220 ,20750469.480 ];
Y=[-16027953.710 ,2290238.988 ,-12687500.250 ,-27845730.100 ,-2345295.901 ,-18429010.410 ];
Z=[23259013.420 ,14685609.220 ,20602453.000 ,3484060.793 ,14750395.800 ,-7962146.345 ];
%S 是X,Y,Z的坐标 合矩阵
S=[X;Y;Z];
%用来计算迭代次数的num
num=0;
%接收机坐标的初始值设为（0,0,0）
site_0=[0 0 0 0]';%分别是X0Y0Z0 Cdt
%给需要用到的参数预先分配内存
Rs=zeros(1,6);%站星距
l=zeros(1,6);
m=zeros(1,6);
n=zeros(1,6);
dCdt=zeros(1,6);
f=zeros(1,6);%迭代开始
while 1for t=1:6                         %此处利用向量的方式更好%循环计算第t个卫星的站星距离Rs(t)=sqrt((S(1,t)-site_0(1,1))^2+(S(2,t)-site_0(2,1))^2+(S(3,t)-site_0(3,1))^2);%由于接收机钟差造成的距离误差Cdt取一个值%计算第t个站星距离的泰勒展开式中的偏导数l,m,n,dCdt=1；l(t)=(site_0(1,1)-S(1,t))./Rs(t) ;m(t)=(site_0(2,1)-S(2,t))./Rs(t);n(t)=(site_0(3,1)-S(3,t))./Rs(t) ;dCdt(t)=1;%计算自由项f(t)=P(t)-Rs(t)+site_0(4);%site_0（4)是Cdtend%循环进入下一颗卫星%待到1-6个卫星都被计算后 ，将所有的卫星的系数组成误差方程，以(x,y,z,cdt)为未知数进行求解 A=[l',m',n',dCdt'];L=f';X=(inv(A'*A))*(A'*L);V=A*X-L;Xi=site_0+X;%如果deltaX小于0.001，则说明上述所计算的接收机坐标基本接近实际值，则结束迭代，反之用本次计算出的接收机坐标重新循环迭代if abs(X(1,1))>0.001||abs(X(2,1))>0.001||abs(X(3,1))>0.001site_0=Xi;                      %把本次用到的坐标赋值给site_0，以便下次循环num=num+1;elsesite_0=Xi;                      %求得满足条件的XYZ，结束迭代break;end
end%输出卫星坐标Xr=site_0(1:3,1);fprintf('计算所得接收机的坐标为：[%.3f, %.3f ,%.3f]',Xr);fprintf('\n');%输出站星距离disp('站星距离为:')t=1:6;Pr(t)=sqrt((S(1,t)-site_0(1,1)).^2+(S(2,t)-site_0(2,1)).^2+(S(3,t)-site_0(3,1)).^2)+site_0(4)%接收机钟差fprintf('\n');disp('接收机钟差:')site_0(4)/(3e+08)

3.最终结果：

4.间接平差C语言：C语言间接平差

GNSS单点定位解算与原理（基于MATLAB）相关推荐

基于matlab的通信原理,基于Matlab的通信原理
基于Matlab的通信原理Tag内容描述: 1.基于基于 MATLABMATLAB 的眼图仿真的眼图仿真及其与通信实验箱之结果的比较及其与通信实验箱之结果的比较摘要摘要通信实验往往可以从硬件和软 ...
四轴飞行玩具的姿态解算的原理1.转动和姿态
前言: 曾经试图自己做四轴无人机.这里是一些相关的笔记. 无人机的几大难点: 1.电机控制(无刷直流电机PWM控制) 2.姿态获取(三轴加速度,陀螺仪,气压,超声,姿态融合,姿态解算) 3.姿态控制 ...
利用matlab实现北斗RNSS单点定位解算
说实话,只要是了解导航的朋友们都知道RNSS单点定位的原理是比较简单的,从几何原理分析,只需要3颗卫星(三球交汇嘛)就能确定用户接收机天线的位置. 但由于卫星钟和接收机中两者内的钟难以保持严格同步,实 ...
NtripShare EdgeEngine GNSS边缘解算盒子/模块/软件用户手册
运行环境 Windows Server.Win7.Win10(X86.X64) Ubuntu.Debian等(X86.X64.Arm64.Arm32) 硬件配置要求内存:512MB以上存储:512 ...
matlab人眼识别原理,基于MATLAB的人眼检测.docx
基于MATLAB的人眼检测要点目录 TOC \o "1-3" \h \z \u HYPERLINK \l "_Toc388122853" 摘要 PAGEREF ...
matlab 四元数叉乘,四轴飞行玩具的姿态解算的原理3. 点乘与叉乘；四元数
在讲四元数之前,先讲下向量的点乘和叉乘. 我们先假设有两个向量 : a = [Xa Ya Za] b=[Xb Yb Zb] 一 . 点乘(·): 点乘又叫内积,他是两个向量的各项乘积之和,其值为一个 ...
matlab 矩阵jocobi迭代_第6章解线性方程组的迭代法(基于MATLAB)
前面我们已经知道对于线性方程组,一般有两种数值解法:直接法和迭代法.直接法前面已经写过了,没看的同学可以移步阅读:直接法.本次主要讲述迭代法及其相应的MATLAB代码. 考虑线性方程组当为低阶稠密 ...
matlab高斯正反算程序6,基于matlab的高斯投影正反算与相邻带坐标换算程序设计...
第卷第期在月中国水运基于的高斯投影正反算与相邻带坐标换算程序设计徐翰 ,周强波 (核工业二三研究所 ,湖南长沙 ) 摘要 :地图投影方法众多 , ...
有关加速度计，陀螺仪，姿态融合解算的原理
机体就好似一条船,姿态就是船的航向(船头的方位),重力是灯塔,陀螺仪(角速度对时间的积分得到的角度)是舵手,加速度计是瞭望手.舵手负责估计和把稳航向,他相信自己,本来船像北开的,就一定会一直往北开,觉 ...

GNSS单点定位解算与原理（基于MATLAB）

基于MATLAB的GNSS单点定位解算

GNSS单点定位解算与原理（基于MATLAB）相关推荐

最新文章

热门文章