发明名称 一种环火探测器精密同步定位守时方法及系统
摘要 一种环火探测器精密同步定位守时方法及系统,首先输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟;根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,得到探测器的轨道和钟差。本发明在建立X射线脉冲星观测模型基础上,将观测模型、探测器动力学模型和星载原子钟的钟差模型进行有机结合,同时估算了探测器的位置、速度和钟差参数,在实现钟差校正的同时也削弱了钟差对定位精度的影响,提高了自主定位精度。
申请公布号 CN104848862A 申请公布日期 2015.08.19
申请号 CN201510306661.1 申请日期 2015.06.05
申请人 武汉大学 发明人 魏二虎;张帅;刘经南;刘建栋;李雪川;李智强
分类号 G01C21/20(2006.01)I 主分类号 G01C21/20(2006.01)I
代理机构 武汉科皓知识产权代理事务所(特殊普通合伙) 42222 代理人 严彦
主权项 一种环火探测器精密同步定位守时方法,其特征在于:包括以下步骤,步骤1,输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;步骤2,进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟,设导航脉冲星组合中包括p颗脉冲星,环火探测器的位置矢量r=[x y z]<sup>T</sup>、速度矢量v=[v<sub>x</sub> v<sub>y</sub> v<sub>z</sub>]<sup>T</sup>,加速度矢量a=[a<sub>x</sub> a<sub>y</sub> a<sub>z</sub>]<sup>T</sup>,所述脉冲星测量方程如下式,<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>Z</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&Delta;</mi><msub><mi>t</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mi>&Delta;</mi><msub><mi>t</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mi>&Delta;</mi><msub><mi>t</mi><mi>p</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mi>H</mi><mo>&CenterDot;</mo><mi>X</mi><mo>+</mo><mi>&eta;</mi></mrow>]]></math><img file="FDA0000732387810000011.GIF" wi="478" he="397" /></maths>其中,Δt<sub>i</sub>表示第i颗脉冲星时延观测量,i的取值为1,2,…,p,p颗脉冲星观测量组成观测向量Z,η为测量噪声,H为观测方程系数矩阵,状态参数X=[x y z v<sub>x</sub> v<sub>y</sub> v<sub>z</sub> x<sub>1</sub>x<sub>2</sub>x<sub>3</sub>]<sup>T</sup>;所述钟差模型如下式,<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>x</mi><mn>1</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mrow><mi>k</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>x</mi><mn>1</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow><mo>+</mo><mi>&epsiv;</mi><mo>&CenterDot;</mo><msub><mi>x</mi><mn>2</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow><mo>+</mo><mfrac><msup><mi>&epsiv;</mi><mn>2</mn></msup><mn>2</mn></mfrac><mo>&CenterDot;</mo><msub><mi>x</mi><mn>3</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow><mo>+</mo><mi>W</mi><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000732387810000012.GIF" wi="998" he="141" /></maths>其中,ε为采样间隔,x<sub>1</sub>(t<sub>k</sub>)、x<sub>2</sub>(t<sub>k</sub>)和x<sub>3</sub>(t<sub>k</sub>)分别表示时刻t<sub>k</sub>原子钟的钟差、频率漂移和频率漂移变化率,组成了钟差参数[x<sub>1</sub> x<sub>2</sub> x<sub>3</sub>];W(t<sub>k</sub>)为时刻t<sub>k</sub>相应的系统噪声,x<sub>1</sub>(t<sub>k+1</sub>)表示时刻t<sub>k+1</sub>原子钟的钟差;步骤3,根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,所述观测方程采用脉冲星测量方程,设时刻t的状态参数X记为X(t),X(t)的一阶导数为<img file="FDA0000732387810000013.GIF" wi="150" he="89" />所述滤波状态方程如下,<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mover><mi>X</mi><mo>.</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>F</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&CenterDot;</mo><mi>X</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mi>W</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000732387810000014.GIF" wi="575" he="87" /></maths>其中,W(t)为系统状态噪声矩阵,状态方程系数矩阵F(t)为,<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>F</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>x</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>y</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>z</mi></mrow></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>x</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>y</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>y</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>y</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>z</mi></mrow></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>z</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>x</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>z</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>y</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>&PartialD;</mo><msub><mi>a</mi><mi>z</mi></msub></mrow><mrow><mo>&PartialD;</mo><mi>z</mi></mrow></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000732387810000021.GIF" wi="963" he="898" /></maths>步骤4,输出步骤3所得滤波结果,包括滤波所得探测器的轨道和钟差。
地址 430072 湖北省武汉市武昌区珞珈山武汉大学