发明名称 一种卫星导航系统非完备条件下的定位方法
摘要 本发明提供一种卫星导航系统非完备条件下的定位方法,属于全球卫星导航定位领域,包括:在卫星信号完备条件下进行正常定位,储存定位信息;当可见卫星数量为2颗或3颗时,执行非完备条件下的定位方法,推算出站心地固坐标系中接收机位置的东向分量和北向分量的关系,根据非完备条件下的接收机位置计算方程,用最小二乘法进行求解获得接收机位置;当可见卫星数量恢复到4颗以上时,执行完备条件下的定位方法。本发明实现了卫星导航接收机在非完备条件下的定位功能,能够有效解决接收机在城市中由于立交桥或者高楼遮挡卫星信号引起的暂时性无法定位的问题。且本发明在非完备条件下的定位精度较高,可达到完备条件下的定位精度水平。
申请公布号 CN102323606B 申请公布日期 2012.12.19
申请号 CN201110218334.2 申请日期 2011.08.01
申请人 北京航空航天大学 发明人 张晓林;侯冰;陈灿辉
分类号 G01S19/42(2010.01)I 主分类号 G01S19/42(2010.01)I
代理机构 北京永创新实专利事务所 11121 代理人 官汉增
主权项 1.一种卫星导航系统非完备条件下的定位方法,其特征在于:具体包括以下步骤:步骤一:在卫星信号完备条件下进行正常定位,储存定位信息:(1)在可见卫星数量为大于等于4颗时,求解接收机位置的方程组为:<maths num="0001"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>&rho;</mi><mn>1</mn></msub><mo>=</mo><msqrt><msup><mrow><mo>(</mo><msub><mi>E</mi><mrow><mi>s</mi><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>E</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>N</mi><mrow><mi>s</mi><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>N</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>U</mi><mrow><mi>s</mi><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>U</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></msqrt><mo>+</mo><mi>c</mi><mo>&CenterDot;</mo><mi>t</mi></mtd></mtr><mtr><mtd><msub><mi>&rho;</mi><mn>2</mn></msub><mo>=</mo><msqrt><msup><mrow><mo>(</mo><msub><mi>E</mi><mrow><mi>s</mi><mn>2</mn></mrow></msub><mo>-</mo><msub><mi>E</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>E</mi><mrow><mi>s</mi><mn>2</mn></mrow></msub><mo>-</mo><msub><mi>N</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>U</mi><mrow><mi>s</mi><mn>2</mn></mrow></msub><mo>-</mo><msub><mi>U</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></msqrt><mo>+</mo><mi>c</mi><mo>&CenterDot;</mo><mi>t</mi></mtd></mtr><mtr><mtd><msub><mi>&rho;</mi><mn>3</mn></msub><mo>=</mo><msqrt><msup><mrow><mo>(</mo><msub><mi>E</mi><mrow><mi>s</mi><mn>3</mn></mrow></msub><mo>-</mo><msub><mi>E</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>N</mi><mrow><mi>s</mi><mn>3</mn></mrow></msub><mo>-</mo><msub><mi>N</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>U</mi><mrow><mi>s</mi><mn>3</mn></mrow></msub><mo>-</mo><msub><mi>U</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></msqrt><mo>+</mo><mi>c</mi><mo>&CenterDot;</mo><mi>t</mi></mtd></mtr><mtr><mtd><msub><mi>&rho;</mi><mn>4</mn></msub><mo>=</mo><msqrt><msup><mrow><mo>(</mo><msub><mi>E</mi><mrow><mi>s</mi><mn>4</mn></mrow></msub><mo>-</mo><msub><mi>E</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>N</mi><mrow><mi>s</mi><mn>4</mn></mrow></msub><mo>-</mo><msub><mi>N</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>U</mi><mrow><mi>s</mi><mn>4</mn></mrow></msub><mo>-</mo><msub><mi>U</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></msqrt><mo>+</mo><mi>c</mi><mo>&CenterDot;</mo><mi>t</mi></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msub><mi>&rho;</mi><mi>m</mi></msub><mo>=</mo><msqrt><msup><mrow><mo>(</mo><msub><mi>E</mi><mi>sm</mi></msub><mo>-</mo><msub><mi>E</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>N</mi><mi>sm</mi></msub><mo>-</mo><msub><mi>N</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>U</mi><mi>sm</mi></msub><mo>-</mo><msub><mi>U</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></msqrt><mo>+</mo><mi>c</mi><mo>&CenterDot;</mo><mi>t</mi></mtd></mtr></mtable></mfenced></math>]]></maths>其中,(E<sub>r</sub>,N<sub>r</sub>,U<sub>r</sub>)为当前历元时刻接收机在站心地固坐标系中的东向、北向和天向位置,(E<sub>si</sub>,N<sub>si</sub>,U<sub>si</sub>)为第i颗可见卫星在站心地固坐标系中的东向、北向和天向位置,ρ<sub>i</sub>为第i颗可见卫星到接收机的伪距测量值,t为接收机时钟与卫星导航系统系统时之间的钟差,c为真空中的光速,此时完备条件下i的取值为i=1~m,m为可见卫星数量;对方程组微分:<maths num="0002"><![CDATA[<math><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>&delta;&rho;</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;&rho;</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;&rho;</mi><mn>3</mn></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;&rho;</mi><mn>4</mn></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msub><mi>&delta;&rho;</mi><mi>m</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>&alpha;</mi><mn>11</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>12</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>13</mn></msub></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msub><mi>&alpha;</mi><mn>21</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>22</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>23</mn></msub></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msub><mi>&alpha;</mi><mn>31</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>32</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>33</mn></msub></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><msub><mi>&alpha;</mi><mn>41</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>42</mn></msub></mtd><mtd><msub><mi>&alpha;</mi><mn>43</mn></msub></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd></mtd><mtd><mo>.</mo></mtd><mtd></mtd><mtd></mtd></mtr><mtr><mtd></mtd><mtd><mo>.</mo></mtd><mtd></mtd><mtd></mtd></mtr><mtr><mtd></mtd><mtd><mo>.</mo></mtd><mtd></mtd><mtd></mtd></mtr><mtr><mtd><msub><mi>&alpha;</mi><mrow><mi>m</mi><mn>1</mn></mrow></msub></mtd><mtd><msub><mi>&alpha;</mi><mrow><mi>m</mi><mn>2</mn></mrow></msub></mtd><mtd><msub><mi>&alpha;</mi><mrow><mi>m</mi><mn>3</mn></mrow></msub></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>&delta;E</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;N</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;U</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><mo>-</mo><mi>c</mi><mo>&CenterDot;</mo><mi>&delta;t</mi></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>其中,δρ<sub>i</sub>为第i颗可见卫星的伪距测量值与预测值之差,δE<sub>r</sub>,δN<sub>r</sub>,δU<sub>r</sub>分别为当前历元时刻接收机在站心地固坐标系中东向、北向、天向位置的增量,δt为当前历元时刻钟差的增量,<img file="FDA00002049597600013.GIF" wi="300" he="121" /><img file="FDA00002049597600014.GIF" wi="298" he="111" /><img file="FDA00002049597600015.GIF" wi="279" he="110" />此时完备条件下i的取值为i=1~m,m为可见卫星数量;对上式用最小二乘法进行求解获得接收机位置;(2)储存定位信息,在每个历元时刻储存一次定位信息;步骤二:当可见卫星数量为2颗或3颗时,执行非完备条件下的定位方法:在每个历元时刻获取可见卫星数量,并在非完备条件出现的初始历元时刻t<sub>0</sub>,将完备条件下最后一个历元时刻存储的接收机位置作为站心地固坐标系原点,将完备条件下最后一个历元时刻存储的钟差作为非完备条件下的固定钟差,将在步骤一储存的接收机位置由地心地固坐标系转换为站心地固坐标系,并推算出站心地固坐标系中接收机位置的东向分量和北向分量的固定比例系数:(E<sub>2</sub>-E<sub>1</sub>)+λ(N<sub>2</sub>-N<sub>1</sub>)=0其中,E<sub>2</sub>、N<sub>2</sub>和E<sub>1</sub>、N<sub>1</sub>分别为t<sub>0</sub>的前一历元时刻和n秒之前接收机在站心地固坐标系中东向和北向的坐标,λ为固定比例系数;非完备条件下的接收机位置计算方程为:<img file="FDA00002049597600021.GIF" wi="1542" he="180" />其中,(E<sub>r</sub>,N<sub>r</sub>,U<sub>r</sub>)为当前历元时刻接收机在站心地固坐标系中的东向、北向和天向位置,(E<sub>sk</sub>,N<sub>sk</sub>,U<sub>sk</sub>)为第k颗可见卫星在站心地固坐标系中的东向、北向和天向位置,此时非完备条件下k的取值为k=1,2或1,2,3,ρ<sub>k</sub>为第k颗可见卫星到接收机的伪距测量值,E<sub>0</sub>、N<sub>0</sub>为任意时刻接收机在站心地固坐标系中东向、北向位置,t为钟差,c为真空中的光速;对上式进行微分后得到:δρ<sub>k</sub>=[α<sub>k2</sub>-λ·α<sub>k1</sub>,α<sub>k3</sub>][δN<sub>r</sub>,δU<sub>r</sub>]<sup>T</sup>    (k=1,2或1,2,3)其中,δρ<sub>k</sub>为第k颗可见卫星的伪距测量值与预测值之差,δN<sub>r</sub>,δU<sub>r</sub>分别为当前历元时刻接收机在站心地固坐标系中北向、天向位置的增量,<img file="FDA00002049597600022.GIF" wi="278" he="121" /><img file="FDA00002049597600023.GIF" wi="282" he="123" /><img file="FDA00002049597600024.GIF" wi="288" he="148" />对上式用最小二乘法进行求解,获得接收机位置;步骤三:当可见卫星数量恢复到4颗以上时,停止非完备条件下的定位方法,返回步骤一,执行完备条件下的定位方法。
地址 100191 北京市海淀区学院路37号
您可能感兴趣的专利