主权项 |
一种环火探测器精密同步定位守时方法,其特征在于:包括以下步骤,步骤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>Δ</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>Δ</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>Δ</mi><msub><mi>t</mi><mi>p</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mi>H</mi><mo>·</mo><mi>X</mi><mo>+</mo><mi>η</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>ϵ</mi><mo>·</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>ϵ</mi><mn>2</mn></msup><mn>2</mn></mfrac><mo>·</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>·</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>∂</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>∂</mo><mi>x</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>∂</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>∂</mo><mi>y</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>∂</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>∂</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>∂</mo><msub><mi>a</mi><mi>x</mi></msub></mrow><mrow><mo>∂</mo><mi>x</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>∂</mo><msub><mi>a</mi><mi>y</mi></msub></mrow><mrow><mo>∂</mo><mi>y</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>∂</mo><msub><mi>a</mi><mi>y</mi></msub></mrow><mrow><mo>∂</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>∂</mo><msub><mi>a</mi><mi>z</mi></msub></mrow><mrow><mo>∂</mo><mi>x</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>∂</mo><msub><mi>a</mi><mi>z</mi></msub></mrow><mrow><mo>∂</mo><mi>y</mi></mrow></mfrac></mtd><mtd><mfrac><mrow><mo>∂</mo><msub><mi>a</mi><mi>z</mi></msub></mrow><mrow><mo>∂</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所得滤波结果,包括滤波所得探测器的轨道和钟差。 |