卫星导航定位算法与程序设计单点定位程序流程样本.doc

资料内容仅供您学习参考，如有不当或者侵权，请联系改正或者删除。
GPS单点定位程序流程
一、 计算流程
1、 读取RINEX N文件, 将所有星历放到一个列表( 数组) 中。

2、 读取RINEX O文件,读取一个历元观测值

3、 数据预处理
根据中的卫星号和历元时刻在查找相应的卫星星历,
准则s。
4、 程序初始化, 置测站概略位置为, 接收机钟差初值。
第一次迭代, 取
5、 选择 中一颗卫星观测值, 设其伪距为
6、 计算卫星的信号发射的概略时刻 方法如下:
a) 卫星的信号传播时间: ;为卫星钟差, 需要进行相对论改正;
b) 卫星的信号发射时刻: ;
c) 卫星在时刻的位置;
d) 对卫星位置进行地球自转改正, 得到;
e) 根据和测站概略位置计算卫星和测站的几何距离
f) 根据几何距离求信号传播时间。
g) 如果 ,则退出迭代。即为卫星信号发射时刻。
h) 否则 , 回带到b)进行迭代。

7、 求卫星方向余弦

8、 求卫星在观测方程式中的余数项:

其中:

9、 选择 中下一颗卫星观测值, 设其伪距为
10、 重复第6—9步, 计算每颗卫星的系数和余数项
11、 将所有卫星的系数组成误差方程, 以为未知参数进行求解, 形式应该是:

12、 求解法方程, 求出定位结果

13、 与进行比较, 判断位置差值,
a) 如果各分量差值>0.001m, 则令, 返回第6步继续迭代计算。
b) 若小于则退出迭代。

14、 输出该历元定位结果。

15、 继续下一历元计算, 下一历元的坐标初始值= 上一历元的定位结果。

16、 返回2, 直到全部历元计算完毕。
二、 程序流程图
2.1总体流程图

2.2 卫星信号发射时刻迭代的流程图