主权项 |
1.一种超紧组合卫星导航接收机,包括射频前端,信号预处理器,基带预滤波器和导航滤波器,以及微惯导模块,伪距和伪距率计算模块,星历解算与选星计算模块,其中信号预处理模块包括相关器和本地信号生成器,其特征在于,所述基带预滤波器与导航滤波器之间设置有自适应滤波器;所述导航滤波器为联邦滤波器,包括主滤波器和至少一个子滤波器;其中,自适应滤波器的输出作为子滤波器的观测输入,主滤波器对各子滤波器的状态进行信息分配;各子滤波器的状态估计输出端连接主滤波器的观测输入端,主滤波器输出信息分配系数反馈给各子滤波器,用以重置子滤波器的状态估计值;所述的信息分配系数的表达式如下:<maths num="0001"><![CDATA[<math><mrow><msub><mi>β</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>Φ</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>Φ</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>T</mi></msubsup><mo>+</mo><msub><mi>Γ</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>Γ</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>δρ</mi></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mi>δN</mi></mtd></mtr><mtr><mtd><msub><mi>Δ</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>Δ</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</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>Δ</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>δρ</mi></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mi></mi></mtd></mtr><mtr><mtd><mi>δN</mi></mtd></mtr><mtr><mtd><msub><mi>Δ</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>Δ</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>δρ</mi></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mi>δN</mi></mtd></mtr><mtr><mtd><msub><mi>Δ</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>Δ</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>ρ</mi></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mover><mi>ρ</mi><mo>.</mo></mover></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mover><mi>ρ</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>δρ</mi></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover></mtd></mtr><mtr><mtd><mi>δN</mi></mtd></mtr><mtr><mtd><msub><mi>Δ</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>Δ</mi><mo>.</mo></mover><mi>ion</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>δ</mi><mover><mi>ρ</mi><mo>.</mo></mover></mtd></mtr><mtr><mtd><mi>δ</mi><mover><mi>ρ</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>Δ</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>Δρ</mi></mtd></mtr><mtr><mtd><mi>Δφ</mi></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>δρ</mi><mo>+</mo><msub><mi>Δ</mi><mi>ion</mi></msub></mtd></mtr><mtr><mtd><mi>δρ</mi><mo>-</mo><msub><mi>Δ</mi><mi>ion</mi></msub><mo>+</mo><mi>δ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>分别为伪距、伪距率、伪距加速度、载波相位整周模糊度、电离层延时、电离层延时率的观测噪声;Δρ为伪距残差测量值,Δφ为载波相位残差测量值。 |