发明名称 一种超紧组合卫星导航接收机
摘要 本发明公开了一种超紧组合卫星导航接收机,包括射频前端,信号预处理器,基带预滤波器和导航滤波器,以及微惯导模块,伪距和伪距率计算模块以及星历解算与选星计算模块,在基带预滤波器与导航滤波器之间设置了自适应滤波器,将基带预滤波器输出作为输入,接入自适应滤波器,然后,将自适应滤波的输出作为观测量输入至导航滤波器进行数据融合,可显著提高跟踪环路稳定性和跟踪精度,从而提高GNSS定位对环境和运动状态的适应能力。进一步地,信号预处理器,基带预滤波器,自适应滤波器和导航滤波器,伪距和伪距率计算模块构成矢量跟踪环路,导航滤波器采用联邦滤波器,可以提高跟踪环路的稳定性和跟踪精度,进而提高GNSS定位可靠性和定位精度等性能。
申请公布号 CN102819029B 申请公布日期 2014.01.22
申请号 CN201210273837.4 申请日期 2012.08.03
申请人 浙江理工大学 发明人 高法钦
分类号 G01S19/48(2010.01)I 主分类号 G01S19/48(2010.01)I
代理机构 杭州天勤知识产权代理有限公司 33224 代理人 胡红娟
主权项 1.一种超紧组合卫星导航接收机,包括射频前端,信号预处理器,基带预滤波器和导航滤波器,以及微惯导模块,伪距和伪距率计算模块,星历解算与选星计算模块,其中信号预处理模块包括相关器和本地信号生成器,其特征在于,所述基带预滤波器与导航滤波器之间设置有自适应滤波器;所述导航滤波器为联邦滤波器,包括主滤波器和至少一个子滤波器;其中,自适应滤波器的输出作为子滤波器的观测输入,主滤波器对各子滤波器的状态进行信息分配;各子滤波器的状态估计输出端连接主滤波器的观测输入端,主滤波器输出信息分配系数反馈给各子滤波器,用以重置子滤波器的状态估计值;所述的信息分配系数的表达式如下:<maths num="0001"><![CDATA[<math><mrow><msub><mi>&beta;</mi><mrow><mi>i</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></msub><mo>=</mo><mfrac><mrow><mi>trace</mi><mo>[</mo><msup><mrow><mo>(</mo><msubsup><mi>P</mi><mrow><mi>ii</mi><mrow><mo>(</mo><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mo>)</mo></mrow><mo>*</mo></msup><mo>]</mo></mrow><mrow><mi>trace</mi><mo>[</mo><msub><mi>M</mi><mi>i</mi></msub><msubsup><mi>P</mi><mrow><mi>g</mi><mrow><mo>(</mo><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msubsup><mi>M</mi><mi>i</mi><mi>T</mi></msubsup><mo>]</mo></mrow></mfrac></mrow></math>]]></maths>其中:β<sub>i(k)</sub>为k时刻下第i子滤波器的信息分配系数,<maths num="0002"><![CDATA[<math><mrow><msup><mrow><mo>(</mo><msubsup><mi>P</mi><mrow><mi>ii</mi><mrow><mo>(</mo><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mo>)</mo></mrow><mo>*</mo></msup><mo>=</mo><msup><mrow><mo>[</mo><msub><mi>&Phi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>P</mi><mrow><mi>ii</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow></msub><msubsup><mi>&Phi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>T</mi></msubsup><mo>+</mo><msub><mi>&Gamma;</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>Q</mi><mrow><mi>i</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow></msub><msubsup><mi>&Gamma;</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>T</mi></msubsup><mo>]</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>,</mo></mrow></math>]]></maths>M<sub>i</sub>是子系统状态X<sub>ik</sub>与总系统状态X<sub>k</sub>之间存在的关系矩阵,Φ<sub>k,k-1</sub>为k时刻下的状态转移矩阵,Q<sub>i(k-1)</sub>为第i个子滤波器k-1时刻下的驱动噪声方差阵,P<sub>ii(k,k-1)</sub>、P<sub>ii(k-1)</sub>分别为第i个子滤波器k-1时刻下的预测误差方差矩阵和估计误差方差矩阵,P<sub>g(k,k-1)</sub>为P<sub>ii(k,k-1)</sub>对应的协方差矩阵,Γk-1为k-1时刻下的驱动噪声系数矩阵;所述的子滤波器包括纯GNSS模式下的GNSS滤波器,超紧组合模式下的GNSS/IMU组合导航滤波器和纯IMU微惯导滤波器;所述的自适应滤波器的状态方程为:<maths num="0003"><![CDATA[<math><mrow><mfrac><mi>d</mi><mi>dt</mi></mfrac><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;&rho;</mi></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mi>&delta;N</mi></mtd></mtr><mtr><mtd><msub><mi>&Delta;</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>&Delta;</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mover><mi>&Delta;</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>a</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>ion</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>观测方程为:<maths num="0004"><![CDATA[<math><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;&rho;</mi></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mi></mi></mtd></mtr><mtr><mtd><mi>&delta;N</mi></mtd></mtr><mtr><mtd><msub><mi>&Delta;</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>&Delta;</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;&rho;</mi></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mi>&delta;N</mi></mtd></mtr><mtr><mtd><msub><mi>&Delta;</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>&Delta;</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr></mtable></mfenced><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>w</mi><mi>&rho;</mi></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mover><mi>&rho;</mi><mo>.</mo></mover></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mover><mi>&rho;</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>N</mi></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>io</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>所述的基带预滤波器的状态方程为:<maths num="0005"><![CDATA[<math><mrow><mfrac><mi>d</mi><mi>dt</mi></mfrac><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;&rho;</mi></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mi>&delta;N</mi></mtd></mtr><mtr><mtd><msub><mi>&Delta;</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>&Delta;</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>&delta;</mi><mover><mi>&rho;</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mover><mi>&Delta;</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>a</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>ion</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>观测方程为:<maths num="0006"><![CDATA[<math><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&Delta;&rho;</mi></mtd></mtr><mtr><mtd><mi>&Delta;&phi;</mi></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&delta;&rho;</mi><mo>+</mo><msub><mi>&Delta;</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><mi>&delta;&rho;</mi><mo>-</mo><msub><mi>&Delta;</mi><mi>ion</mi></msub><mo>+</mo><mi>&delta;N</mi></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>其中:δρ为伪距残差,<img file="FDA0000385597070000026.GIF" wi="69" he="62" />为伪距率残差,<img file="FDA0000385597070000024.GIF" wi="73" he="64" />为伪距加速度残差,δN为载波相位整周残差,Δ<sub>ion</sub>为电离层延时,<img file="FDA0000385597070000025.GIF" wi="104" he="83" />为电离层延时率,w<sub>a</sub>为伪距加速度过程噪声,w<sub>ion</sub>为电离层噪声,w<sub>ρ</sub>、<img file="FDA0000385597070000027.GIF" wi="172" he="54" />w<sub>N</sub>、w<sub>i</sub>、w<sub>io</sub>分别为伪距、伪距率、伪距加速度、载波相位整周模糊度、电离层延时、电离层延时率的观测噪声;Δρ为伪距残差测量值,Δφ为载波相位残差测量值。
地址 310018 浙江省杭州市下沙高教园区2号大街5号