主权项 |
一种卫星导航PVT解算方法,其特征在于,所述方法包括,步骤A,初始化用户位置([x<sub>u,0</sub> y<sub>u,0</sub> z<sub>u,0</sub>])、钟差<img file="FDA0000997060460000011.GIF" wi="114" he="79" />当前时刻用户位置与钟差对应的误差协方差矩阵<img file="FDA0000997060460000012.GIF" wi="74" he="83" />用户速度([vx<sub>u,0</sub> vy<sub>u,0</sub> vz<sub>u,0</sub>])、频偏δf<sub>0</sub>,当前时刻用户速度与频偏对应的误差协方差矩阵<img file="FDA0000997060460000013.GIF" wi="98" he="87" />步骤B,将上述误差协方差矩阵<img file="FDA0000997060460000014.GIF" wi="49" he="84" />与<img file="FDA0000997060460000015.GIF" wi="72" he="87" />进行UD分解;步骤C,针对当前时刻的所有有效卫星,化简量测更新方程:伪距方程和多普勒方程;步骤D,对每个有效伪距方程以及多普勒方程中的量测误差进行加权处理;步骤E,针对每个伪距方程以及多普勒方程,进行序贯方式U‑D量测更新;步骤F,在所有的量测方程完成上述量测更新后,得到最终用户位置、钟差、速度、频偏状态的最优误差估计,将得到的所述最优误差估计迭代上一个时刻的输出值,得到当前时刻最终用户的位置、钟差、速度、频偏估计;步骤G,进入下一时刻并进入步骤C。 |