发明名称 一种快速脉冲星导航整周模糊度解算方法
摘要 一种快速脉冲星导航整周模糊度解算方法,分为地面实现部分与星上处理部分,地面实现部分对应于步骤1~步骤7,通在地面实现相关模型与模板的建立以节省星上计算时间,星上处理部分对应于步骤8~步骤12,称为基于粒子群优化的压缩模板匹配搜索方法。本发明满足了未来脉冲星导航系统快速并准确地建立航天器初始位置的需求,利用本发明可以用显著性水平参数来控制模糊度求解成功概率,并使用压缩模板指数来提高了模糊度解算效率,最终有效保证了模糊度能够成功与快速解算,能够正确并快速确定航天器的初始位置。
申请公布号 CN103674022B 申请公布日期 2016.08.17
申请号 CN201310701574.7 申请日期 2013.12.19
申请人 中国空间技术研究院 发明人 黄良伟;帅平;陈绍龙;贝晓敏
分类号 G01C21/02(2006.01)I;G06F19/00(2011.01)I 主分类号 G01C21/02(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 一种快速脉冲星导航整周模糊度解算方法,其特征在于实现步骤如下:步骤1:确定导航脉冲星与检验脉冲星导航脉冲星为3颗,检验脉冲星为1颗,按照相位量测精度由高至低排序,3颗导航脉冲星与1颗检验脉冲星构成1个模糊度解算单元;步骤2:建立模糊度解算单元的模糊度量测方程所建立模糊度量测方程表达式为:y=m+Bx+e式中:m=[m<sub>1</sub>,m<sub>2</sub>,m<sub>3</sub>,m<sub>4</sub>]<sup>T</sup>,为模糊度解算单元各脉冲星的模糊度;y=[y<sub>1</sub>,y<sub>2</sub>,y<sub>3</sub>,y<sub>4</sub>]<sup>T</sup>为模糊度解算单元各脉冲星的相位量测;e=[e<sub>1</sub>,e<sub>2</sub>,e<sub>3</sub>,e<sub>4</sub>]<sup>T</sup>为模糊度解算单元各脉冲星的相位量测误差,设其服从零均值的4维正态分布,即e~N<sub>4</sub>(0,R),R为对称正定的方差矩阵,满足E(ee<sup>T</sup>)=R&gt;0;x=[x<sub>1</sub>,x<sub>2</sub>,x<sub>3</sub>]<sup>T</sup>为航天器3维位置矢量;B=[b<sub>1</sub>,b<sub>2</sub>,b<sub>3</sub>,b<sub>4</sub>]<sup>T</sup>为脉冲星方向矢量矩阵,有b<sub>i</sub>=c<sup>‑1</sup>f<sub>i</sub>[cosδ<sub>i</sub>cosα<sub>i</sub>,cosδ<sub>i</sub>sinα<sub>i</sub>,sinδ<sub>i</sub>]<sup>T</sup>,i=1,2,3,4其中,c为真空中的光速,f<sub>i</sub>,i=1,2,3,4,为模糊度解算单元各脉冲星的自转频率,α<sub>i</sub>与δ<sub>i</sub>,i=1,2,3,4,分别为模糊度解算单元各脉冲星的赤径与赤纬;步骤3:根据步骤2得到的模糊度量测方程y建立线性模糊度接受域模型,具体步骤如下:步骤3.1:定义C≡I‑BX,其中,X=(B<sup>T</sup>R<sup>‑1</sup>B)<sup>‑1</sup>B<sup>T</sup>R<sup>‑1</sup>,I为4阶单位阵,通过奇异值分解(SVD),将C分解为<img file="FDA0000928271510000011.GIF" wi="206" he="62" />其中,σ<sub>1</sub>为C的唯一非零奇异值,u<sub>1</sub>与v<sub>1</sub>分别为C对应于σ<sub>1</sub>的左奇异向量与右奇异向量;步骤3.2:求得方差矩阵R的逆的开方矩阵W,W满足W≥0,且W<sup>2</sup>=R<sup>‑1</sup>;步骤3.3:给定显著性水平α,求得自由度为1的χ<sup>2</sup>分布的上侧分位数<img file="FDA0000928271510000012.GIF" wi="119" he="63" />步骤3.4:建立线性模糊度接受域模型,表达式为<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mo>|</mo><msup><mi>l</mi><mi>T</mi></msup><mover><mi>m</mi><mo>~</mo></mover><mo>-</mo><mover><mi>M</mi><mo>~</mo></mover><mo>|</mo><mo>&le;</mo><mi>D</mi></mrow>]]></math><img file="FDA0000928271510000013.GIF" wi="253" he="69" /></maths>式中:<img file="FDA0000928271510000014.GIF" wi="363" he="63" />为模糊度解算单元各脉冲星的模糊度估值,即为待检验模糊度;<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>l</mi><mo>=</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><msubsup><mi>v</mi><mn>1</mn><mi>T</mi></msubsup><mo>,</mo></mrow>]]></math><img file="FDA0000928271510000015.GIF" wi="166" he="62" /></maths>记为l=[l<sub>1</sub>,l<sub>2</sub>,l<sub>3</sub>,l<sub>4</sub>]<sup>T</sup>;<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>D</mi><mo>=</mo><mo>|</mo><mo>|</mo><mi>k</mi><mo>|</mo><msup><mo>|</mo><mrow><mo>-</mo><mn>1</mn></mrow></msup><msqrt><mrow><msubsup><mi>&chi;</mi><mi>&alpha;</mi><mn>2</mn></msubsup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></msqrt><mo>,</mo></mrow>]]></math><img file="FDA0000928271510000016.GIF" wi="317" he="86" /></maths>有k=Wu<sub>1</sub>,||||表示向量的模值;<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mover><mi>M</mi><mo>~</mo></mover><mo>=</mo><msup><mi>z</mi><mi>T</mi></msup><mi>k</mi><mo>|</mo><mo>|</mo><mi>k</mi><mo>|</mo><msup><mo>|</mo><mrow><mo>-</mo><mn>2</mn></mrow></msup><mo>,</mo></mrow>]]></math><img file="FDA0000928271510000017.GIF" wi="261" he="79" /></maths>z=WCy;步骤4:根据航天器任务确定航天器参考原点以及航天器至参考原点的最大可能距离R<sub>max</sub>,以参考原点为球心,以R<sub>max</sub>为半径的球应能覆盖航天器任何可能位置;步骤5:依据步骤4选定的R<sub>max</sub>确定模糊度搜索空间模糊度搜索空间用模糊度的下界和上界来描述,即对于一个模糊度解算单元,b<sub>Li</sub>与b<sub>Ui</sub>,i=1,2,3,4分别为模糊度的下界与上界,即m<sub>i</sub>∈[b<sub>Li</sub>,b<sub>Ui</sub>],b<sub>Li</sub>与b<sub>Ui</sub>的计算公式为:<maths num="0005" id="cmaths0005"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>b</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>=</mo><mi>r</mi><mi>o</mi><mi>u</mi><mi>n</mi><mi>d</mi><mrow><mo>(</mo><mo>-</mo><msup><mi>c</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><msub><mi>R</mi><mrow><mi>m</mi><mi>a</mi><mi>x</mi></mrow></msub><msub><mi>f</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>b</mi><mrow><mi>U</mi><mi>i</mi></mrow></msub><mo>=</mo><mi>r</mi><mi>o</mi><mi>u</mi><mi>n</mi><mi>d</mi><mrow><mo>(</mo><msup><mi>c</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><msub><mi>R</mi><mrow><mi>m</mi><mi>a</mi><mi>x</mi></mrow></msub><msub><mi>f</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><mn>1</mn></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000928271510000021.GIF" wi="445" he="142" /></maths>其中,round(·)表示四舍五入;步骤6:依据步骤5确定的模糊度搜索空间,再根据步骤4选定的R<sub>max</sub>,确定压缩模板指数γ<sub>m</sub>,对于给定的模糊度搜索空间与选定的R<sub>max</sub>,通过数学仿真对γ<sub>m</sub>进行试配;步骤7:根据步骤6确定的γ<sub>m</sub>值,建立压缩模板V,记3颗导航脉冲量模糊度增量估值为<img file="FDA0000928271510000022.GIF" wi="407" he="63" />V是由<img file="FDA0000928271510000023.GIF" wi="80" he="63" />构成的向量集合,满足<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mi>V</mi><mo>=</mo><mo>{</mo><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>|</mo><mo>|</mo><msub><mi>&delta;</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>)</mo></mrow><mo>|</mo><mo>&le;</mo><mrow><mo>(</mo><mn>1</mn><mo>+</mo><mn>1</mn><mo>/</mo><msub><mi>&gamma;</mi><mi>m</mi></msub><mo>)</mo></mrow><mi>D</mi><mo>/</mo><mo>|</mo><msub><mi>l</mi><mn>4</mn></msub><mo>|</mo><mo>,</mo><mo>|</mo><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>i</mi></msub><mo>|</mo><mo>&lt;</mo><msub><mi>b</mi><mrow><mi>U</mi><mi>i</mi></mrow></msub><mo>-</mo><msub><mi>b</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>,</mo><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>i</mi></msub><mo>&Element;</mo><mi>Z</mi><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>3</mn><mo>}</mo></mrow>]]></math><img file="FDA0000928271510000024.GIF" wi="1262" he="74" /></maths>式中:Z代表整数集合;记l<sub>n</sub>=[l<sub>1</sub>,l<sub>2</sub>,l<sub>3</sub>],有<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>&delta;</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>)</mo></mrow><mo>=</mo><mo>-</mo><mn>1</mn><mo>/</mo><msub><mi>l</mi><mn>4</mn></msub><msubsup><mi>l</mi><mi>n</mi><mi>T</mi></msubsup><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>-</mo><mi>r</mi><mi>o</mi><mi>u</mi><mi>n</mi><mi>d</mi><mrow><mo>(</mo><mo>-</mo><mn>1</mn><mo>/</mo><msub><mi>l</mi><mn>4</mn></msub><msubsup><mi>l</mi><mi>n</mi><mi>T</mi></msubsup><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>)</mo></mrow><mo>&Element;</mo><mo>&lsqb;</mo><mo>-</mo><mn>0.5</mn><mo>,</mo><mn>0.5</mn><mo>)</mo><mo>;</mo></mrow>]]></math><img file="FDA0000928271510000025.GIF" wi="966" he="76" /></maths>步骤8:使用粒子群优化方法搜寻满足初始接受域的初始解根据步骤3建立的线性模糊度接受域模型与步骤6确定的γ<sub>m</sub>值,确定初始接受域为<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mo>|</mo><msup><mi>l</mi><mi>T</mi></msup><msub><mover><mi>m</mi><mo>~</mo></mover><mn>0</mn></msub><mo>-</mo><mover><mi>M</mi><mo>~</mo></mover><mo>|</mo><mo>&le;</mo><mi>D</mi><mo>/</mo><msub><mi>&gamma;</mi><mi>m</mi></msub></mrow>]]></math><img file="FDA0000928271510000026.GIF" wi="334" he="70" /></maths>式中:<img file="FDA0000928271510000027.GIF" wi="414" he="64" />为模糊度求解单元初始模糊度估值,有m<sub>0i</sub>∈[b<sub>Li</sub>,b<sub>Ui</sub>],i=1,2,3,4,对第j颗检验星,使用粒子群优化方法获得满足初始接受域的初始解<img file="FDA0000928271510000028.GIF" wi="79" he="62" />进而确定3颗导航脉冲星初始模糊度估值<img file="FDA0000928271510000029.GIF" wi="375" he="63" />步骤9:根据步骤7建立的压缩模板V与步骤8获得的满足初始接受域的初始解<img file="FDA00009282715100000210.GIF" wi="81" he="63" />按下式构建3颗导航脉冲星模糊度估值<img file="FDA00009282715100000211.GIF" wi="60" he="62" />构成的备选集合S:<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><mi>S</mi><mo>=</mo><mo>{</mo><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>=</mo><msub><mover><mi>m</mi><mo>~</mo></mover><mrow><mi>n</mi><mn>0</mn></mrow></msub><mo>+</mo><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>|</mo><mi>&delta;</mi><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>&Element;</mo><mi>V</mi><mo>,</mo><msub><mover><mi>m</mi><mo>~</mo></mover><mrow><mi>n</mi><mi>i</mi></mrow></msub><mo>&Element;</mo><mo>&lsqb;</mo><msub><mi>b</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>b</mi><mrow><mi>U</mi><mi>i</mi></mrow></msub><mo>&rsqb;</mo><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>3</mn><mo>}</mo></mrow>]]></math><img file="FDA00009282715100000212.GIF" wi="965" he="78" /></maths>步骤10:如果|S|=1,其中|·|指集合元素的个数,则完成搜索,S中的元素即为导航星的模糊度;如果|S|=0,本次搜索失败,返回步骤8重新搜索;如果|S|&gt;1,进行步骤11;步骤11:根据步骤9或步骤12确定的3颗导航脉冲星模糊度估值备选集合S,使j=j+1,对于第j颗检验星,使用3维顺序遍历来构建进一步缩小范围的模糊度估值备选集合S:<img file="FDA0000928271510000031.GIF" wi="613" he="77" />其中,U由步骤2得到的线性形式的接受域模型得到,对于第j颗检验星有:<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><mi>U</mi><mo>=</mo><mo>&lsqb;</mo><mrow><mo>(</mo><mover><mi>M</mi><mo>~</mo></mover><mo>-</mo><mi>D</mi><mo>-</mo><msubsup><mi>l</mi><mi>n</mi><mi>T</mi></msubsup><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>)</mo></mrow><mo>/</mo><msub><mi>l</mi><mn>4</mn></msub><mo>,</mo><mrow><mo>(</mo><mover><mi>M</mi><mo>~</mo></mover><mo>+</mo><mi>D</mi><mo>-</mo><msubsup><mi>l</mi><mi>n</mi><mi>T</mi></msubsup><msub><mover><mi>m</mi><mo>~</mo></mover><mi>n</mi></msub><mo>)</mo></mrow><mo>/</mo><msub><mi>l</mi><mn>4</mn></msub><mo>&rsqb;</mo></mrow>]]></math><img file="FDA0000928271510000032.GIF" wi="774" he="64" /></maths>步骤12:如果|S|=1,搜索完成,S中元素即为导航星的模糊度;如果|S|=0,本次搜索失败,返回步骤8重新搜索;如果|S|&gt;1,返回步骤11。
地址 100194 北京市海淀区友谊路104号