主权项 |
一种数据链与卫星导航协同定位方法,其特征在于,该方法包含:获得定位目标与可见卫星之间的伪距方程,如式(14):<math><![CDATA[<mrow><msubsup><mi>ρ</mi><mi>i</mi><mi>s</mi></msubsup><mo>=</mo><msqrt><mrow><msup><mrow><mo>(</mo><msubsup><mi>x</mi><mi>i</mi><mi>s</mi></msubsup><mo>-</mo><mi>x</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mi>y</mi><mi>i</mi><mi>s</mi></msubsup><mo>-</mo><mi>y</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mi>z</mi><mi>i</mi><mi>s</mi></msubsup><mo>-</mo><mi>z</mi><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt><mo>+</mo><mi>c</mi><mo>·</mo><mi>Δ</mi><mi>t</mi><mo>+</mo><msub><mi>n</mi><mi>i</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000857257030000011.GIF" wi="1550" he="90" /></maths>其中,(x,y,z)是所求的定位目标的坐标;<img file="FDA0000857257030000012.GIF" wi="62" he="62" />为定位目标与第i颗GNSS卫星之间的伪距,<img file="FDA0000857257030000013.GIF" wi="253" he="87" />是第i颗卫星的坐标;n<sub>i</sub>为观测误差;△t是本地GNSS接收机与卫星系统的钟差;定位目标接收具有数据链功能的载机发送的星历信息,计算可见卫星两两之间的伪距差值;根据伪距差值,建立其他可见卫星与定位目标的伪距观测方程,如式(17):<math><![CDATA[<mrow><msubsup><mover><mi>ρ</mi><mo>^</mo></mover><mi>j</mi><mi>s</mi></msubsup><mo>=</mo><msqrt><mrow><msup><mrow><mo>(</mo><msubsup><mi>x</mi><mi>j</mi><mi>s</mi></msubsup><mo>-</mo><mi>x</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mi>y</mi><mi>j</mi><mi>s</mi></msubsup><mo>-</mo><mi>y</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mi>z</mi><mi>j</mi><mi>s</mi></msubsup><mo>-</mo><mi>z</mi><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt><mo>+</mo><mi>c</mi><mo>·</mo><mi>Δ</mi><mi>t</mi><mo>+</mo><msub><mi>n</mi><mi>j</mi></msub><mrow><mo>(</mo><mi>j</mi><mo>≠</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000857257030000014.GIF" wi="1524" he="102" /></maths><img file="FDA0000857257030000015.GIF" wi="77" he="69" />为定位目标与其他卫星的观测伪距;通过测距,获得定位目标与载机的测距方程,如式(18):<math><![CDATA[<mrow><msubsup><mi>ρ</mi><mi>j</mi><mi>c</mi></msubsup><mo>=</mo><msqrt><mrow><msup><mrow><mo>(</mo><msubsup><mi>x</mi><mi>j</mi><mi>c</mi></msubsup><mo>-</mo><mi>x</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mi>y</mi><mi>j</mi><mi>c</mi></msubsup><mo>-</mo><mi>y</mi><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msubsup><mi>z</mi><mi>j</mi><mi>c</mi></msubsup><mo>-</mo><mi>z</mi><mo>)</mo></mrow><mn>2</mn></msup></mrow></msqrt><mo>+</mo><msub><mi>n</mi><mi>j</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>18</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000857257030000016.GIF" wi="1405" he="102" /></maths>其中<img file="FDA0000857257030000017.GIF" wi="62" he="77" />为定位目标与第j个载机之间的距离,<img file="FDA0000857257030000018.GIF" wi="251" he="79" />是第j个载机的坐标;联立式(14)、(15)、(16),对定位目标进行定位解算,获取定位目标的定位信息。 |