发明名称 用于北斗卫星导航定位系统的联合时间同步与定位方法
摘要 本发明涉及用于北斗卫星导航定位系统的联合时间同步与定位方法,该方法利用地面接收机获得的来自多个北斗卫星导航卫星的导航电文以及地面接收机收到导航电文时的信号到达时间TOA来对地面接收机的进行联合时间同步和定位解算。本发明采用了两步加权最小二乘算法来对接收机时钟进行校正和位置解算。本发明能有效降低运算的时间和能耗,提高北斗卫星导航系统对地面接收机定位效率。
申请公布号 CN103869345B 申请公布日期 2016.03.30
申请号 CN201410002014.7 申请日期 2014.01.01
申请人 深圳北斗国芯科技有限公司 发明人 杨乐;黄俊;薛延波;付寅飞;李秀魁
分类号 G01S19/35(2010.01)I;G04R20/02(2013.01)I 主分类号 G01S19/35(2010.01)I
代理机构 广州市越秀区哲力专利商标事务所(普通合伙) 44288 代理人 李悦;齐文剑
主权项 用于北斗卫星导航定位系统的联合时间同步与定位方法,其特征在于,包括以下步骤:(1)地面接收机根据接收到的北斗卫星导航电文中的钟差参数计算信号发送的北斗时t<sub>k</sub>,下标k表示卫星编号;(2)地面接收机根据接收到的北斗卫星导航电文中的星历参数计算北斗卫星在大地坐标系中的坐标p<sub>k</sub>=[X<sub>k</sub>,Y<sub>k</sub>,Z<sub>k</sub>]<sup>T</sup>和时钟相偏τ<sub>k</sub>,下标k表示卫星编号;(3)利用北斗时t<sub>k</sub>和坐标p<sub>k</sub>建立TOA观测模型:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>T</mi><mi>k</mi></msub><mo>+</mo><msub><mi>&tau;</mi><mi>k</mi></msub><mo>=</mo><mi>&tau;</mi><mo>+</mo><msub><mi>t</mi><mi>k</mi></msub><mo>+</mo><mfrac><mrow><mo>|</mo><mo>|</mo><mi>u</mi><mo>-</mo><msub><mi>p</mi><mi>k</mi></msub><mo>|</mo><mo>|</mo></mrow><mi>c</mi></mfrac><mo>+</mo><msub><mi>&Delta;T</mi><mi>k</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000823284140000011.GIF" wi="1214" he="134" /></maths>式中,T<sub>k</sub>为地面接收机观测到的编号为k的卫星发送信号的到达时间,τ为地面接收机的时钟偏差,u=[X,Y,Z]<sup>T</sup>为地面接收机的位置坐标,c为光速,△T<sub>k</sub>为TOA测量误差;(4)对式(1)两边同乘以c,得到:r<sub>k</sub>=t+||u‑p<sub>k</sub>||+n<sub>k</sub>         (2)式中,r<sub>k</sub>=c(T<sub>k</sub>+τ<sub>k</sub>‑t<sub>k</sub>),t=cτ,n<sub>k</sub>=c△T<sub>k</sub>;(5)将式(2)两边平方,引入中间变量η=u<sup>T</sup>u‑t<sup>2</sup>;定义待估计变量<img file="FDA0000823284140000012.GIF" wi="303" he="79" />使之线性化,得到:<img file="FDA0000823284140000013.GIF" wi="1022" he="103" />式中<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>h</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>,</mo><mo>:</mo><mo>)</mo></mrow><mo>=</mo><mo>&lsqb;</mo><msubsup><mi>r</mi><mi>k</mi><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>p</mi><mi>k</mi><mi>T</mi></msubsup><msub><mi>p</mi><mi>k</mi></msub><mo>&rsqb;</mo><mo>,</mo><msub><mi>G</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>,</mo><mo>:</mo><mo>)</mo></mrow><mo>=</mo><mo>&lsqb;</mo><mn>2</mn><msub><mi>r</mi><mi>k</mi></msub><mo>,</mo><mo>-</mo><mn>2</mn><msubsup><mi>p</mi><mi>k</mi><mi>T</mi></msubsup><mo>,</mo><mn>1</mn><mo>&rsqb;</mo><mo>;</mo></mrow>]]></math><img file="FDA0000823284140000014.GIF" wi="997" he="86" /></maths>(6)对式(3)采用加权最小二乘估计算法获得<img file="FDA0000823284140000015.GIF" wi="310" he="79" />的估计:<img file="FDA0000823284140000016.GIF" wi="1148" he="119" />其中,<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>W</mi><mn>1</mn></msub><mo>=</mo><mi>E</mi><msup><mrow><mo>&lsqb;</mo><msub><mi>&epsiv;</mi><mn>1</mn></msub><msubsup><mi>&epsiv;</mi><mn>1</mn><mi>T</mi></msubsup><mo>&rsqb;</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>=</mo><msubsup><mi>B</mi><mn>1</mn><mrow><mo>-</mo><mi>T</mi></mrow></msubsup><msubsup><mi>B</mi><mn>1</mn><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mo>/</mo><msubsup><mi>&sigma;</mi><mi>n</mi><mn>2</mn></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000823284140000021.GIF" wi="1172" he="102" /></maths>B<sub>1</sub>=2·diag([||u‑p<sub>1</sub>||,||u‑p<sub>2</sub>||,,||u‑p<sub>K</sub>||])         (6)(7)定义待估计变量<img file="FDA0000823284140000022.GIF" wi="66" he="72" />的估计误差<img file="FDA0000823284140000023.GIF" wi="454" he="79" />其中<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>&Delta;</mi><mover><mi>t</mi><mo>&OverBar;</mo></mover><mo>=</mo><mover><mi>t</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>t</mi><mo>,</mo><mi>&Delta;</mi><mover><mi>u</mi><mo>&OverBar;</mo></mover><mo>=</mo><mover><mi>u</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>u</mi><mo>,</mo><mi>&Delta;</mi><mover><mi>&eta;</mi><mo>&OverBar;</mo></mover><mo>=</mo><mover><mi>&eta;</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>&eta;</mi><mo>,</mo></mrow>]]></math><img file="FDA0000823284140000024.GIF" wi="821" he="71" /></maths>将其代入在(3)式中提出的中间变量η,得到:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>&Delta;</mi><mover><mi>&eta;</mi><mo>&OverBar;</mo></mover><mo>=</mo><mover><mi>&eta;</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>&eta;</mi><mo>=</mo><mover><mi>&eta;</mi><mo>&OverBar;</mo></mover><mo>-</mo><msup><mover><mi>u</mi><mo>&OverBar;</mo></mover><mi>T</mi></msup><mover><mi>u</mi><mo>&OverBar;</mo></mover><mo>+</mo><msup><mover><mi>t</mi><mo>&OverBar;</mo></mover><mn>2</mn></msup><mo>-</mo><mn>2</mn><mover><mi>t</mi><mo>&OverBar;</mo></mover><mi>&Delta;</mi><mover><mi>t</mi><mo>&OverBar;</mo></mover><mo>+</mo><mn>2</mn><msup><mover><mi>u</mi><mo>&OverBar;</mo></mover><mi>T</mi></msup><mi>&Delta;</mi><mover><mi>u</mi><mo>&OverBar;</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000823284140000025.GIF" wi="1333" he="100" /></maths>(8)定义:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mo>-</mo><mi>&Delta;</mi><mover><mi>t</mi><mo>&OverBar;</mo></mover><mo>=</mo><mn>0</mn><mo>-</mo><mi>&Delta;</mi><mover><mi>t</mi><mo>&OverBar;</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000823284140000026.GIF" wi="1029" he="83" /></maths><maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mo>-</mo><mi>&Delta;</mi><mover><mi>u</mi><mo>&OverBar;</mo></mover><mo>=</mo><mn>0</mn><mo>-</mo><mi>&Delta;</mi><mover><mi>u</mi><mo>&OverBar;</mo></mover></mrow>]]></math><img file="FDA0000823284140000027.GIF" wi="309" he="60" /></maths>联立式(7)和式(8)得到:<img file="FDA0000823284140000028.GIF" wi="1220" he="351" />式中,<img file="FDA0000823284140000029.GIF" wi="245" he="70" />B<sub>2</sub>=diag([‑1,‑1,‑1,1]);(9)<img file="FDA00008232841400000210.GIF" wi="69" he="64" />的加权最小二乘估计为:<img file="FDA00008232841400000211.GIF" wi="1166" he="102" /><img file="FDA00008232841400000212.GIF" wi="1114" he="103" />(10)令<img file="FDA00008232841400000213.GIF" wi="374" he="86" />计算地面接收机的最终时钟偏差估计<img file="FDA00008232841400000214.GIF" wi="38" he="63" />和位置坐标估计<img file="FDA00008232841400000215.GIF" wi="75" he="62" /><maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mover><mi>&tau;</mi><mo>^</mo></mover><mo>=</mo><mrow><mo>(</mo><mover><mi>t</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>&Delta;</mi><mover><mover><mi>t</mi><mo>&OverBar;</mo></mover><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mo>/</mo><mi>c</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00008232841400000216.GIF" wi="1045" he="83" /></maths><maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><mover><mi>u</mi><mo>^</mo></mover><mo>=</mo><mover><mi>u</mi><mo>&OverBar;</mo></mover><mo>-</mo><mi>&Delta;</mi><mover><mover><mi>u</mi><mo>&OverBar;</mo></mover><mo>&OverBar;</mo></mover></mrow>]]></math><img file="FDA00008232841400000217.GIF" wi="246" he="63" /></maths>
地址 518000 广东省深圳市龙岗区清林西路龙岗留学生创业园一园315、317
您可能感兴趣的专利