一种低成本GNSS气压计组合RTK定位方法与流程

文档序号:12457241阅读:来源:国知局

技术特征:

1.一种低成本GNSS气压计组合RTK定位方法,其特征在于:该方法包括以下步骤:

S1:周跳探测;

S2:形成双差观测方程;

S3:Kalman滤波估计;

S4:气压计约束模糊度解算。

2.根据权利要求1所述的一种低成本GNSS气压计组合RTK定位方法,其特征在于:在步骤S1中,采用多普勒周跳探测方法,形成单差观测值探测周跳:

<mrow> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>c</mi> <mrow> <mi>t</mi> <mn>1</mn> <mi>t</mi> <mn>2</mn> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&Delta;L</mi> <mi>i</mi> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>-</mo> <msubsup> <mi>&Delta;L</mi> <mi>i</mi> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> </mrow> <mo>)</mo> </mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>D</mi> <mi>g</mi> <mi>j</mi> </msubsup> <mo>-</mo> <msubsup> <mi>D</mi> <mi>g</mi> <mi>k</mi> </msubsup> </mrow> <mo>)</mo> </mrow> <mo>&times;</mo> <mrow> <mo>(</mo> <mrow> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>1</mn> </msub> </mrow> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

由于观测时间间隔较短,卫星变化不大,此方法可以有效探测到2周周跳;

<mrow> <mo>|</mo> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>c</mi> <mrow> <mi>t</mi> <mn>1</mn> <mi>t</mi> <mn>2</mn> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mo>|</mo> <mo>&GreaterEqual;</mo> <mi>&delta;</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

δ为域值,设置为1.8,如果超过该域值,则认为有周跳发生,即重新初始化该模糊度参数。

3.根据权利要求2所述的一种低成本GNSS气压计组合RTK定位方法,其特征在于:在步骤S2中,接收的基准站(A)观测数据分别与载体模块(B)接收数据形成双差观测方程为:

<mrow> <mtable> <mtr> <mtd> <mrow> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>L</mi> <mrow> <mi>A</mi> <mi>B</mi> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mo>=</mo> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>&rho;</mi> <mrow> <mi>A</mi> <mi>B</mi> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mo>+</mo> <msub> <mi>&lambda;</mi> <mi>g</mi> </msub> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>N</mi> <mrow> <mi>A</mi> <mi>B</mi> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mo>+</mo> <msub> <mi>&epsiv;</mi> <mrow> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>L</mi> <mrow> <mi>A</mi> <mi>B</mi> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>P</mi> <mrow> <mi>A</mi> <mi>B</mi> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mo>=</mo> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>&rho;</mi> <mrow> <mi>A</mi> <mi>B</mi> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> <mo>+</mo> <msub> <mi>&epsiv;</mi> <mrow> <mi>&Delta;</mi> <mo>&dtri;</mo> <msubsup> <mi>P</mi> <mrow> <mi>A</mi> <mi>B</mi> </mrow> <mrow> <mi>j</mi> <mi>k</mi> </mrow> </msubsup> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

式中,为A、B接收机的双差伪距观测值,表示以米为单位的A、B接收机的双差载波相位观测值,为A、B接收机到卫星的双差距离,λg为载波波长,为第一频段载波的A、B接收机双差电离层延迟,为A、B接收机双差对流层延迟,载波的双差整周模糊度值,表示双差伪距的观测噪声,表示双差载波相位的观测噪声。

4.根据权利要求3所述的一种低成本GNSS气压计组合RTK定位方法,其特征在于:在步骤S3中,采用Kalman滤波估计对应的待估参数,其过程为:

<mrow> <msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>H</mi> <mi>k</mi> </msub> <msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>K</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>-</mo> <msub> <mi>A</mi> <mi>k</mi> </msub> <msub> <mi>H</mi> <mi>k</mi> </msub> <msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> </mrow> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>

Qk/k=(E-KkAk)HkQk (5)

式中yk为伪距与载波相位观测值,Ak为观测值的系数矩阵,为k-1历元的状态向量,为预测的状态向量,为当前k历元的状态向量,Kk为增益矩阵;

<mrow> <msub> <mi>K</mi> <mi>k</mi> </msub> <mo>=</mo> <msub> <mi>H</mi> <mi>k</mi> </msub> <msub> <mi>Q</mi> <mrow> <mi>k</mi> <mo>/</mo> <mi>k</mi> </mrow> </msub> <msubsup> <mi>H</mi> <mi>k</mi> <mi>T</mi> </msubsup> <msubsup> <mi>A</mi> <mi>k</mi> <mi>T</mi> </msubsup> <msup> <mrow> <mo>(</mo> <mrow> <msub> <mi>A</mi> <mi>k</mi> </msub> <msub> <mi>H</mi> <mi>k</mi> </msub> <msub> <mi>Q</mi> <mrow> <mi>k</mi> <mo>/</mo> <mi>k</mi> </mrow> </msub> <msubsup> <mi>H</mi> <mi>k</mi> <mi>T</mi> </msubsup> <msubsup> <mi>A</mi> <mi>k</mi> <mi>T</mi> </msubsup> <mo>+</mo> <mi>R</mi> </mrow> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> <mo>.</mo> </mrow>

5.根据权利要求4所述的一种低成本GNSS气压计组合RTK定位方法,其特征在于:在步骤S4中,采用序贯最小二乘技术,计算模糊度浮点解及其方差协方差阵此时采用约束LAMBDA方法解算模糊度,获得模糊度的固定解:

<mrow> <msub> <mover> <mi>a</mi> <mo>&OverBar;</mo> </mover> <mrow> <mo>(</mo> <mrow> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>...</mn> <mo>,</mo> <mi>n</mi> </mrow> <mo>)</mo> </mrow> </msub> <mo>=</mo> <mi>arg</mi> <munder> <mi>min</mi> <mrow> <mi>z</mi> <mo>&Element;</mo> <mi>Z</mi> </mrow> </munder> <mrow> <mo>(</mo> <mrow> <mi>z</mi> <mo>-</mo> <mover> <mi>a</mi> <mo>^</mo> </mover> </mrow> <mo>)</mo> </mrow> <msubsup> <mi>Q</mi> <mrow> <mover> <mi>b</mi> <mo>^</mo> </mover> <mover> <mi>b</mi> <mo>^</mo> </mover> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <msup> <mrow> <mo>(</mo> <mrow> <mi>z</mi> <mo>-</mo> <mover> <mi>a</mi> <mo>^</mo> </mover> </mrow> <mo>)</mo> </mrow> <mi>T</mi> </msup> </mrow>

式中z为整数模糊度候选矢量,为最优n组模糊度解算结果;

对于每组模糊度值,更新基线向量:

<mrow> <mover> <mi>b</mi> <mo>^</mo> </mover> <mo>(</mo> <msub> <mover> <mi>a</mi> <mo>&OverBar;</mo> </mover> <mi>j</mi> </msub> <mo>)</mo> <mo>=</mo> <mover> <mi>b</mi> <mo>^</mo> </mover> <mo>+</mo> <msub> <mi>Q</mi> <mrow> <mover> <mi>b</mi> <mo>^</mo> </mover> <mover> <mi>a</mi> <mo>^</mo> </mover> </mrow> </msub> <msubsup> <mi>Q</mi> <mrow> <mover> <mi>a</mi> <mo>^</mo> </mover> <mover> <mi>a</mi> <mo>^</mo> </mover> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mo>&times;</mo> <mrow> <mo>(</mo> <msub> <mover> <mi>a</mi> <mo>&OverBar;</mo> </mover> <mi>i</mi> </msub> <mo>-</mo> <mover> <mi>a</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <mo>,</mo> <mi>i</mi> <mo>&Element;</mo> <mo>&lsqb;</mo> <mrow> <mn>1</mn> <mo>,</mo> <mi>n</mi> </mrow> <mo>&rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

式中为基线向量与模糊度的协方差,为浮点解基线向量,为固定解基线向量;由于气压相对高度已知,此时利用已知的气压相对高度约束选取对应的模糊度整数解:

<mrow> <mi>u</mi> <mo>-</mo> <mi>&delta;</mi> <mi>u</mi> <mo>&le;</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>u</mi> <mo>^</mo> </mover> <mo>(</mo> <msub> <mover> <mi>a</mi> <mo>&OverBar;</mo> </mover> <mi>k</mi> </msub> <mo>)</mo> <mo>|</mo> <mo>|</mo> <mo>&le;</mo> <mi>u</mi> <mo>+</mo> <mi>&delta;</mi> <mi>u</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>

式中u为已知的气压相对高度,δu为误差范围,为固定解的气压相对高度。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1