一种时间-空间差分的GPS/SINS超紧组合导航方法与流程

文档序号:11808755阅读:来源:国知局
一种时间-空间差分的GPS/SINS超紧组合导航方法与流程

技术特征:
1.一种时间-空间差分的GPS/SINS超紧组合导航方法,其特征在于,包括以下几个步骤:步骤一:利用捷联惯导的输出信息预测载波角速度误差的时间-空间差分观测值和初相位误差的时间-空间差分观测值;步骤二:利用GPS接收机输出信息计算载波角速度误差的时间-空间差分观测值和初相位误差的时间-空间差分观测值;步骤三:将步骤一和步骤二中得到的载波角速度误差的时间-空间差分观测值和初相位误差的时间-空间差分观测值作差,作为系统模型的量测:所述步骤三包括:施加扰动得到系统的量测方程为:其中,e(t)为视线向量,δηθ和δηω为量测噪声;lb为杆臂对位置测量的影响在载体坐标系b下的投影;δlb为状态方程中的杆臂误差δl=[δlxδlyδlz]T,δlx、δly、δlz分别代表x、y、z三个方向陀螺的杆臂误差分量;和即为状态变量中的速度误差δv=[δvEδvNδvU]T和位置误差δp=[δLδλδh]T;即陀螺常值漂移ε0=[ε0xε0yε0z]T;姿态误差角ψ=[ψEψNψU]T,ψ(t2)-ψ(t1)用Δtε0近似得到相关方程:为载波角速度误差的时间-空间差分观测值;为载波初相位误差的时间-空间差分观测值;将步骤一和二中得到的结果作差就得到量测即当观测的卫星数目大于2时,分别对两颗不同的卫星进行时间-空间差分,量测为Z=[(Zj,m)T(Zj,q)T…(Zm,q)T]T,其中j,m,q为卫星编号,量测方程为:Z(t)=H(t)X(t)+η(t),f是载波L1的频率,t1和t2是两个相邻时刻;时间间隔为Δt;δL、δλ、δh分别代表经度误差、纬度误差和高度误差;δvE、δvN、δvU分别代表东向速度误差、北向速度误差和天向速度误差;ψE、ψN、ψU分别代表东、北、天三个方向姿态误差角;为SINS预测的载波初相位误差的时间-空间差分观测值;为SINS预测的载波角速度误差的时间-空间差分观测值;为GPS计算载波初相位误差的时间-空间差分观测值;为GPS计算载波角速度误差的时间-空间差分观测值;ε0x、ε0y、ε0z分别代表x、y、z三个方向陀螺的常值漂移;为载体相对于惯性坐标系i的角速度在b系下的投影;为由载体系b到导航坐标系n的转换矩阵,λ为载波L1的波长;c为光速;为由地心地固坐标系到导航坐标系的坐标变换矩阵;步骤四:利用卡尔曼滤波器估计系统状态,利用估计结果校正惯性元件误差和捷联惯导解算的导航信息;步骤五:利用校正后的导航信息计算多普勒频移,并输入接收机对其进行校正。
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1