主权项 |
1.一种应用于全球卫星定位与导航系统中的快速定位方法,其特征在于,包括以下步骤:1)从接收机的存储设备中获取接收机的初始时间和卫星星历;2)进行卫星的捕获和跟踪从而获取卫星的实测多普勒观测值,并进行码相位时间计数器的累积得到码相位的值;3)利用获取的接收机的初始时间、卫星星历和n颗卫星的实测多普勒观测值组建多普勒解算方程,并对该多普勒解算方程进行解算得到卫星发射时间和接收机的位置估算值与初始值的差值;利用通过多普勒解算获得的差值和接收机的初始时间以及卫星星历计算出卫星发射时间和接收机位置的估算值;4)将步骤3)中解算得到的卫星发射时间和接收机位置的估算值作为不完备伪距解算方程的输入条件,组建不完备伪距解算方程,解算得到卫星发射时间和接收机的位置的准确值与步骤3)得出的估算值的差值,利用通过不完备伪距解算获得的差值和卫星发射时间以及接收机位置的估算值,从而可求出卫星发射时间和接收机位置的准确值;其中,所述步骤3)中n颗卫星联合多普勒解算方程为:<maths num="0001"><![CDATA[<math><mrow><msup><mi>ρ</mi><mo>′</mo></msup><mo>-</mo><msup><mover><mi>ρ</mi><mo>^</mo></mover><mo>′</mo></msup><mo>=</mo><msup><mrow><mo>(</mo><mi>H</mi><mo>·</mo><mi>ΔX</mi><mo>)</mo></mrow><mo>′</mo></msup><mo>=</mo><mi>H</mi><mo>·</mo><mi>Δ</mi><msup><mi>X</mi><mo>′</mo></msup><mo>+</mo><msup><mi>H</mi><mo>′</mo></msup><mo>·</mo><mi>ΔX</mi></mrow></math>]]></maths> (式1)其中:ρ′为实测多普勒值,<img file="FDA0000378978820000012.GIF" wi="58" he="71" />为多普勒估计值;<maths num="0002"><![CDATA[<math><mrow><mi>H</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>e</mi><mn>1</mn></msup></mtd><mtd><msup><mi>v</mi><mn>1</mn></msup><mo>·</mo><msup><mi>e</mi><mn>1</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msup><mi>e</mi><mn>2</mn></msup></mtd><mtd><msup><mi>v</mi><mn>2</mn></msup><mo>·</mo><msup><mi>e</mi><mn>2</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msup><mi>e</mi><mn>3</mn></msup></mtd><mtd><msup><mi>v</mi><mn>3</mn></msup><mo>·</mo><msup><mi>e</mi><mn>3</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><msup><mi>e</mi><mi>n</mi></msup></mtd><mtd><msup><mi>v</mi><mi>n</mi></msup><mo>·</mo><msup><mi>e</mi><mi>n</mi></msup></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>为余弦阵;v<sup>i</sup>为卫星速度;e<sup>i</sup>为卫星到接收机的视距余弦;ΔX=[δx δy δz δT<sub>s</sub> δb]<sup>T</sup>为状态向量,表示估算值与初始值的差值;则<maths num="0003"><![CDATA[<math><mrow><mi>H</mi><mo>·</mo><msup><mi>ΔX</mi><mo>′</mo></msup><mo>=</mo><mi>H</mi><mo>·</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>δx</mi><mo>′</mo></msup></mtd><mtd><msup><mi>δy</mi><mo>′</mo></msup></mtd><mtd><msup><mi>δz</mi><mo>′</mo></msup></mtd><mtd><msubsup><mi>δT</mi><mi>s</mi><mo>′</mo></msubsup></mtd><mtd><msup><mi>δb</mi><mo>′</mo></msup></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>;</mo></mrow></math>]]></maths><maths num="0004"><![CDATA[<math><mrow><msup><mi>H</mi><mo>′</mo></msup><mo>·</mo><mi>ΔX</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mn>1</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><msup><mrow><mo>∂</mo><mi>v</mi></mrow><mn>1</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi><mo>·</mo><msup><mi>e</mi><mn>1</mn></msup><mo>+</mo><msup><mi>v</mi><mn>1</mn></msup><mo>·</mo><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mn>1</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mn>2</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><msup><mrow><mo>∂</mo><mi>t</mi></mrow><mn>2</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi><mo>·</mo><msup><mi>e</mi><mn>2</mn></msup><mo>+</mo><msup><mi>v</mi><mn>2</mn></msup><mo>·</mo><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mn>2</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mn>3</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><msup><mrow><mo>∂</mo><mi>t</mi></mrow><mn>3</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi><mo>·</mo><msup><mi>e</mi><mn>3</mn></msup><mo>+</mo><msup><mi>v</mi><mn>3</mn></msup><mo>·</mo><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mn>3</mn></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><msup><mrow><mo>∂</mo><mi>n</mi></mrow><mi>n</mi></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><msup><mrow><mo>∂</mo><mi>v</mi></mrow><mi>n</mi></msup><mo>/</mo><mo>∂</mo><mi>t</mi><mo>·</mo><msup><mi>e</mi><mi>n</mi></msup><mo>+</mo><msup><mi>v</mi><mi>n</mi></msup><mo>·</mo><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mi>n</mi></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>·</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>δx</mi></mtd></mtr><mtr><mtd><mi>δy</mi></mtd></mtr><mtr><mtd><mi>δz</mi></mtd></mtr><mtr><mtd><msub><mi>δT</mi><mi>s</mi></msub></mtd></mtr><mtr><mtd><mi>δb</mi></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths>令<maths num="0005"><![CDATA[<math><mrow><msup><mi>u</mi><mi>i</mi></msup><mo>=</mo><msup><mrow><mo>∂</mo><mi>e</mi></mrow><mi>i</mi></msup><mo>/</mo><mo>∂</mo><mi>t</mi><mo>,</mo><msup><mi>a</mi><mi>i</mi></msup><mo>=</mo><msup><mrow><mo>∂</mo><mi>v</mi></mrow><mi>i</mi></msup><mo>/</mo><mo>∂</mo><mi>t</mi></mrow></math>]]></maths>为卫星加速度;令δx′=0、δy′=0、δz′=0、<img file="FDA0000378978820000022.GIF" wi="183" he="73" /><img file="FDA0000378978820000023.GIF" wi="266" he="71" />则多普勒解算方程(式1)改写如下:<maths num="0006"><![CDATA[<math><mrow><mi>d</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>u</mi><mn>1</mn></msup></mtd><mtd><msup><mi>a</mi><mn>1</mn></msup><mo>·</mo><msup><mi>e</mi><mn>1</mn></msup><mo>+</mo><msup><mi>v</mi><mn>1</mn></msup><mo>·</mo><msup><mi>u</mi><mn>1</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msup><mi>u</mi><mn>2</mn></msup></mtd><mtd><msup><mi>a</mi><mn>2</mn></msup><mo>·</mo><msup><mi>e</mi><mn>2</mn></msup><mo>+</mo><msup><mi>v</mi><mn>2</mn></msup><mo>·</mo><msup><mi>u</mi><mn>2</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msup><mi>u</mi><mn>3</mn></msup></mtd><mtd><msup><mi>a</mi><mn>3</mn></msup><mo>·</mo><msup><mi>e</mi><mn>3</mn></msup><mo>+</mo><msup><mi>v</mi><mn>3</mn></msup><mo>·</mo><msup><mi>u</mi><mn>3</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><msup><mi>u</mi><mi>n</mi></msup></mtd><mtd><msup><mi>a</mi><mi>n</mi></msup><mo>·</mo><msup><mi>e</mi><mi>n</mi></msup><mo>+</mo><msup><mi>v</mi><mi>n</mi></msup><mo>·</mo><msup><mi>u</mi><mi>n</mi></msup></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>·</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>δx</mi></mtd></mtr><mtr><mtd><mi>δy</mi></mtd></mtr><mtr><mtd><mi>δz</mi></mtd></mtr><mtr><mtd><msub><mi>δT</mi><mi>s</mi></msub></mtd></mtr><mtr><mtd><msup><mi>δb</mi><mo>′</mo></msup></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths>令<maths num="0007"><![CDATA[<math><mrow><mi>M</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>u</mi><mn>1</mn></msup></mtd><mtd><msup><mi>a</mi><mn>1</mn></msup><mo>·</mo><msup><mi>e</mi><mn>1</mn></msup><mo>+</mo><msup><mi>v</mi><mn>1</mn></msup><mo>·</mo><msup><mi>u</mi><mn>1</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msup><mi>u</mi><mn>2</mn></msup></mtd><mtd><msup><mi>a</mi><mn>2</mn></msup><mo>·</mo><msup><mi>e</mi><mn>2</mn></msup><mo>+</mo><msup><mi>v</mi><mn>2</mn></msup><mo>·</mo><msup><mi>u</mi><mn>2</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msup><mi>u</mi><mn>3</mn></msup></mtd><mtd><msup><mi>a</mi><mn>3</mn></msup><mo>·</mo><msup><mi>e</mi><mn>3</mn></msup><mo>+</mo><msup><mi>v</mi><mn>3</mn></msup><mo>·</mo><msup><mi>u</mi><mn>3</mn></msup></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd><mtd><mo>·</mo></mtd></mtr><mtr><mtd><msup><mi>u</mi><mi>n</mi></msup></mtd><mtd><msup><mi>a</mi><mi>n</mi></msup><mo>·</mo><msup><mi>e</mi><mi>n</mi></msup><mo>+</mo><msup><mi>v</mi><mi>n</mi></msup><mo>·</mo><msup><mi>u</mi><mi>n</mi></msup></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths>y=[δx δy δz δT<sub>s</sub> δb′]<sup>T</sup>,则利用最小二乘求解y=(Μ<sup>T</sup>·Μ)<sup>-1</sup>·(Μ<sup>T</sup>·d),求得卫星发射时间和接收机位置估算值与初始值的差值,从而计算出位置坐标和卫星发射时间的估算值;其中,所述快速定位方法是利用码相位的值进行定位解算,所述步骤4)中不完备伪距解算方程为:第i号卫星不完备伪距表示如下:<maths num="0008"><![CDATA[<math><mrow><msup><mi>l</mi><mi>i</mi></msup><mo>=</mo><msub><mi>frac</mi><mi>Λ</mi></msub><mrow><mo>(</mo><msup><mi>ΛN</mi><mi>i</mi></msup><mo>+</mo><msup><mi>φ</mi><mi>i</mi></msup><mo>+</mo><msub><mi>b</mi><mn>0</mn></msub><mo>-</mo><mo>|</mo><mo>|</mo><msup><mi>s</mi><mi>i</mi></msup><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>r</mi><mn>0</mn></msub><mo>|</mo><mo>|</mo><mo>+</mo><mi>ϵ</mi><mo>)</mo></mrow></mrow></math>]]></maths>式中:<maths num="0009"><![CDATA[<math><mrow><mi>fra</mi><msub><mi>c</mi><mi>Λ</mi></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><mi>x</mi><mo>-</mo><mi>round</mi><mrow><mo>(</mo><mfrac><mi>x</mi><mi>Λ</mi></mfrac><mo>)</mo></mrow><mo>;</mo></mrow></math>]]></maths>Λ=1ms×光速≈300km;ΛN<sup>i</sup>+φ<sup>i</sup>为第i号卫星的信号发射时间;N<sup>i</sup>为1ms以上的计数值;φ<sup>i</sup>为ms以下的码相位值;(t<sub>0</sub>,r<sub>0</sub>,b<sub>0</sub>)为步骤3计算的卫星发射时间估算值、接收机位置估算值和设定的钟差初始估计值,其中r<sub>0</sub>=(x<sub>0</sub>,y<sub>0</sub>,z<sub>0</sub>);ε为误差之和,所述误差包括对流层、电离层。 |