CN104864875B - 一种基于非线性h∞滤波的航天器自主定位方法 - Google Patents
一种基于非线性h∞滤波的航天器自主定位方法 Download PDFInfo
- Publication number
- CN104864875B CN104864875B CN201510158859.XA CN201510158859A CN104864875B CN 104864875 B CN104864875 B CN 104864875B CN 201510158859 A CN201510158859 A CN 201510158859A CN 104864875 B CN104864875 B CN 104864875B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msup
- mover
- msubsup
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000001914 filtration Methods 0.000 title claims abstract description 51
- 238000000034 method Methods 0.000 title claims abstract description 27
- 230000002567 autonomic effect Effects 0.000 title abstract 2
- 239000013598 vector Substances 0.000 claims abstract description 41
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 27
- 238000004364 calculation method Methods 0.000 claims abstract description 13
- 238000005259 measurement Methods 0.000 claims abstract description 10
- 238000012546 transfer Methods 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000012545 processing Methods 0.000 claims description 4
- 238000013461 design Methods 0.000 description 6
- 238000011160 research Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 4
- 230000002411 adverse Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 238000013213 extrapolation Methods 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000004083 survival effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
一种基于非线性H∞滤波的航天器自主定位方法，选择航天器的位置矢量和速度矢量在地心惯性系的投影作为状态变量，将航天器轨道动力学方程作为系统模型，将脉冲星时间转换方程作为测量模型，将脉冲星星表误差描述为模型中的有界误差，基于模型设计用于状态估计的非线性H∞滤波算法；进而，采用所设计的非线性H∞滤波算法，处理脉冲到达时间观测量序列，通过递推计算估计出航天器的位置和速度。本发明所述方法能够增强X射线脉冲星导航系统克服星表误差影响的能力，改善航天器自主定位精度。
Description
技术领域
本发明涉及一种基于非线性H∞滤波的航天器自主定位方法，属于航天器自主导航技术领域。
背景技术
X射线脉冲星导航作为一项新兴的航天器自主导航技术，是当前国内外航天技术领域的研究热点之一。由NASA(美国航空航天局)和DARPA(国防高级研究计划局)资助的研究团队所取得的成果展示了X射线脉冲星在导航领域的巨大潜力，国内中科院高能所、西光所和中国空间技术研究院等正在进行用于空间导航的X射线探测器的研制。
典型的脉冲星导航方式是基于航天器轨道动力学模型建立状态方程，基于脉冲星角位置信息和脉冲星时间模型建立观测方程，采用适当的滤波算法处理由X射线探测器获得的脉冲到达时间(TOA)观测量，估计得到航天器的位置矢量和速度矢量。受目前X射线脉冲星天文观测水平和模型精度的限制，用于建立观测方程的脉冲星角位置数据不可避免会存在误差。脉冲星角位置误差通常称为星表误差，星表误差是影响脉冲星导航系统性能的主要因素之一。
事实上，星表误差可看作模型不确定性，存在模型不确定性的情况下，基于最优滤波理论设计的卡尔曼滤波(KF)及其改进算法，实际上都是次优的。为了解决这一问题，提出一种基于非线性H∞滤波的脉冲星导航方法，该方法能够消弱星表误差的影响，提高X射线脉冲星导航精度。
发明内容
本发明的技术解决问题是：克服现有技术的不足，提出一种基于非线性H∞滤波的航天器自主定位方法，将有关星表误差的先验知识用于优化滤波增益阵的设计，使包含在系统模型和观测量中的信息得到充分合理的运用，从而抑制星表误差对估计精度的不利影响，提高地球轨道航天器自主导航精度。
本发明的技术解决方案是：
一种基于非线性H∞滤波的航天器自主定位方法，步骤如下：
(1)选择参与导航的地球轨道航天器的位置矢量和速度矢量在地心惯性坐标系的分量作为状态变量；
(2)在所述地球轨道航天器上配置X射线探测器，通过X射线探测器测量脉冲星辐射的脉冲信号，获取脉冲到达时间观测量；
(3)利用非线性H∞滤波算法处理步骤(2)中得到的脉冲到达时间观测量，获得状态变量的估计值，即地球轨道航天器的位置矢量和速度矢量的估计值，从而实现了地球轨道航天器的自主定位。
所述步骤(1)中状态变量为：
其中，
r＝[rx ry rz]T
r和表示地球轨道航天器的位置矢量和速度矢量，rx,ry,rz表示位置矢量的三个分量，vx,vy,vz表示速度矢量的三个分量。
所述步骤(2)中脉冲到达时间观测量为：
yt＝h(xt)+vt
其中，
yt表示脉冲到达时间观测量，h(xt)为中间变量，vt表示测量噪声，表示脉冲信号到达太阳系质心SSB的时间，根据脉冲星时间模型预测得到；c表示光速，n(p)表示脉冲星视线矢量，表示SSB到脉冲星的距离，b是SSB相对于太阳质心的位置矢量，b为SSB相对于太阳质心的距离，μs是太阳引力常数，robs是地球轨道航天器相对于SSB的位置矢量，其计算公式为
robs＝re+r
其中，re表示地球中心相对于SSB的位置矢量。
所述步骤(3)中通过非线性H∞滤波算法处理脉冲到达时间观测量，获得状态变量的估计值具体为：
其中，和分别为t时刻状态变量的估计值和预测值，为t-1时刻状态变量的估计值，T为滤波周期，为已知的状态转移函数，Kt为非线性H∞滤波算法的增益阵，且有：
其中，I为单位矩阵，Pt|t-1为估计误差方差阵，通过所述非线性H∞滤波算法递推计算得到；γ为可调滤波参数且γ＝(1×104)2；Ht为观测方程的雅克比矩阵，其计算公式为
Dt是用于描述星表误差影响的不确定性矩阵，其计算公式为
其中，和分别表示脉冲星星表中带有误差的赤经和赤纬，和分别表示星表中赤经和赤纬的误差界；Rt表示测量噪声方差阵，为正定阵。
本发明与现有技术相比的有益效果是：
传统扩展卡尔曼滤波(EKF)算法的估计精度会受到脉冲星星表误差的不利影响，造成导航精度下降。本发明将星表误差视为模型不确定性的一部分，采用非线性H∞滤波(NRF)技术进行处理，通过优化滤波增益阵的设计，所提算法能够增强X射线脉冲星导航系统克服星表误差影响的能力，获得优于传统扩展卡尔曼滤波的导航精度。此外，本发明所设计的基于非线性H∞滤波的脉冲星导航算法与传统扩展卡尔曼滤波算法在实现形式上的区别仅在于滤波增益阵的计算方式不同，不会显著增大算法的计算量，具有较强的实用性。
附图说明
图1为本发明流程图；
图2为扩展卡尔曼滤波的估计误差曲线；
图3为非线性H∞滤波的估计误差曲线。
具体实施方式
下面结合附图对本发明的具体实施方式进行进一步的详细描述。
在脉冲星导航系统中，脉冲星星表误差体现为测量模型的不确定性。在存在模型不确定的系统中，如何设计滤波器，使其估计结果满足一定的设计指标要求，这属于H∞滤波的研究范畴。与传统卡尔曼滤波等最优滤波算法不同，H∞滤波在设计阶段就考虑了模型不确定性的影响，并将有关模型不确定性的先验知识用于优化滤波增益阵的设计，使包含在系统模型和观测量中的信息得到合理的运用，从而抑制模型不确定性对估计精度的不利影响。基于非线性H∞滤波的脉冲星导航方法流程可归纳如下：选择航天器的位置矢量和速度矢量在地心惯性系的投影作为状态变量，将航天器轨道动力学方程作为系统模型，将脉冲星时间转换方程作为测量模型，将脉冲星星表误差描述为模型中的有界误差，基于模型设计用于状态估计的非线性H∞滤波算法；进而，采用所设计的非线性H∞滤波算法，处理脉冲到达时间观测量序列，通过递推计算估计出航天器的位置和速度。
本发明提出一种基于非线性H∞滤波的航天器自主定位方法，如图1所示，步骤如下：
(1)选择参与导航的地球轨道航天器的位置矢量和速度矢量在地心惯性坐标系的分量作为状态变量。状态变量的数学表达式为：
其中，
r＝[rx ry rz]T
r和表示地球轨道航天器的位置矢量和速度矢量，rx,ry,rz表示位置矢量的三个分量，vx,vy,vz表示速度矢量的三个分量。
(2)在所述地球轨道航天器上配置X射线探测器，通过X射线探测器获取脉冲到达时间观测量；目前在国内，北京控制工程研究所等单位均研制了用于脉冲到达时间测量的X射线探测器。脉冲到达时间观测量的数学表达式为：
yt＝h(xt)+vt
其中，
yt表示脉冲到达时间观测量，vt表示测量噪声，表示脉冲信号到达太阳系质心(SSB)的时间，可根据脉冲星时间模型精确的预测得到，c表示光速，n(p)表示脉冲星视线矢量，表示SSB到脉冲星的距离，b是SSB相对于太阳质心的位置矢量，μs是太阳引力常数，robs是航天器相对于SSB的位置矢量，其计算公式为
robs＝re+r
其中，re表示地球中心相对于SSB的位置矢量。上述两式中的c、n(p)、b、μs和re均为已知量。观测方程的推导过程可参见中国宇航出版社2009年出版的由帅平、李明、陈绍龙、黄震编著的《X射线脉冲星导航系统原理与方法》一书。
(3)利用非线性H∞滤波算法处理步骤(2)中得到的脉冲到达时间观测量，获得状态变量的估计值，即地球轨道航天器的位置矢量和速度矢量的估计值，从而实现了地球轨道航天器的自主导航。
扩展卡尔曼滤波算法是通过如下公式进行：
其中，和分别为t时刻状态变量的估计值和预测值，为t-1时刻状态变量的估计值，T为滤波周期，可取为1s，为已知的状态转移函数，Kt为非线性H∞滤波算法的增益阵。
考虑地球的非球形引力摄动，状态转移函数如下所示：
其中，μ为地球引力常数，J2为二阶带谐项系数，Re为地球平均赤道半径，表示地心距。参数μ、J2和Re均为已知量。状态转移函数的推导过程可参见北京航空航天大学出版社1998年出版的由章仁为编著的《卫星轨道姿态动力学与控制》一书。
非线性H∞滤波算法的增益阵计算公式如下所示：
其中，Pt|t-1为估计误差方差阵，可通过滤波算法的递推计算得到，估计误差方差阵的递推计算过程可参考西北工业大学出版社1998出版的由秦永元、张洪钺、汪叔华编写的《卡尔曼滤波与组合导航原理》一书；γ为可调滤波参数，通常取为正常数，对于本实施例，可选择γ＝(1×104)2；Ht为观测方程的雅克比矩阵，其计算公式为
Dt是用于描述星表误差影响的不确定性矩阵，其计算公式为
其中，和分别表示脉冲星星表中带有误差的赤经和赤纬，和分别表示星表中赤经和赤纬的误差界，均为已知量；Rt表示测量噪声方差阵，为已知正定阵。
下面，以地球轨道航天器自主导航为例，通过仿真实例验证本发明所述方法的有效性。设航天器在半长轴12275km，偏心率0.0038，轨道倾角109.8°的轨道上环绕地球运动。假定X射线探测器分时段观测3颗脉冲星B0531+21、B1821-24和B1937+21，仿真时间为地球卫星的3个轨道周期，轨道外推数据每1s更新一次。地球轨道航天器的初始位置误差设为1km，初始速度误差设为1m/s。
仿真过程中，分别采用扩展卡尔曼滤波(EKF)算法和非线性H∞滤波(NRF)算法处理脉冲到达时间观测量，估计地球轨道航天器的位置矢量和速度矢量，EKF的位置估计误差曲线如图2所示，NRF的位置估计误差曲线如图3所示。图2和图3中实线均表示位置估计误差曲线，虚线均表示通过估计误差方差阵递推得到的期望定位精度，每幅图均包括从上到下三幅图，分别对应卫星位置矢量的3个分量。纵坐标表示位置估计误差的大小，单位为m，横坐标表示时间，单位为轨道周期。根据图2和图3不难看出，存在星表误差的情况下，采用非线性H∞滤波算法进行航天器自主定位导航，能够获得优于传统扩展卡尔曼滤波的导航精度。通过统计计算可知，EKF的定位精度约为1211.1m，NRF的定位精度约为559.8m。通过对比可知，本发明所述方法精度更高。
仿真结果表明，本发明提出的基于非线性H∞滤波的脉冲星定位方法能够实现地球轨道航天器高精度自主导航。本发明的主要技术内容可用于实现具有较高精度需求的卫星自主导航任务，有助于降低卫星对地面测控的依赖程度，增强卫星系统在紧急情况下的自主生存能力。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (3)
1.一种基于非线性H∞滤波的航天器自主定位方法，其特征在于步骤如下：
(1)选择参与导航的地球轨道航天器的位置矢量和速度矢量在地心惯性坐标系的分量作为状态变量；
(2)在所述地球轨道航天器上配置X射线探测器，通过X射线探测器测量脉冲星辐射的脉冲信号，获取脉冲到达时间观测量；
(3)利用非线性H∞滤波算法处理步骤(2)中得到的脉冲到达时间观测量，获得状态变量的估计值，即地球轨道航天器的位置矢量和速度矢量的估计值，从而实现了地球轨道航天器的自主定位；
具体为：
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>T</mi>
</mrow>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mi>t</mi>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>t</mi>
</msub>
<mo>&lsqb;</mo>
<msub>
<mi>y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>h</mi>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
其中，yt表示脉冲到达时间观测量，和分别为t时刻状态变量的估计值和预测值，为t-1时刻状态变量的估计值，T为滤波周期，为已知的状态转移函数，Kt为非线性H∞滤波算法的增益阵，且有：
<mrow>
<msub>
<mi>K</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>P</mi>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mo>-</mo>
<msup>
<mi>&gamma;</mi>
<mrow>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msup>
<mi>I</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<msubsup>
<mi>H</mi>
<mi>t</mi>
<mi>T</mi>
</msubsup>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msub>
<mi>H</mi>
<mi>t</mi>
</msub>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>P</mi>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mo>-</mo>
<msup>
<mi>&gamma;</mi>
<mrow>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msup>
<mi>I</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<msubsup>
<mi>H</mi>
<mi>t</mi>
<mi>T</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>D</mi>
<mi>t</mi>
<mi>T</mi>
</msubsup>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msubsup>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>T</mi>
</msubsup>
<msub>
<mi>D</mi>
<mi>t</mi>
</msub>
<mo>+</mo>
<msub>
<mi>R</mi>
<mi>t</mi>
</msub>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>;</mo>
</mrow>
其中，I为单位矩阵，Pt|t-1为估计误差方差阵，通过所述非线性H∞滤波算法递推计算得到；γ为可调滤波参数且γ＝(1×104)2；Ht为观测方程的雅克比矩阵，其计算公式为
<mrow>
<msub>
<mi>H</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>h</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>&part;</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
</mrow>
</mfrac>
<msub>
<mo>|</mo>
<mrow>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>|</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</msub>
</mrow>
Dt是用于描述星表误差影响的不确定性矩阵，其计算公式为
<mrow>
<msub>
<mi>D</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&delta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&delta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<msubsup>
<mi>b</mi>
<mi>&alpha;</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msubsup>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&delta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&delta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&alpha;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>&delta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<msubsup>
<mi>b</mi>
<mi>&delta;</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msubsup>
</mrow>
其中，和分别表示脉冲星星表中带有误差的赤经和赤纬，和分别表示星表中赤经和赤纬的误差界；Rt表示测量噪声方差阵，为正定阵。
2.根据权利要求1所述的一种基于非线性H∞滤波的航天器自主定位方法，其特征在于：所述步骤(1)中状态变量为：
<mrow>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msup>
<mi>r</mi>
<mi>T</mi>
</msup>
</mtd>
<mtd>
<msup>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>T</mi>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
</mrow>
其中，
r＝[rx ry rz]T
<mrow>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>v</mi>
<mi>y</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>v</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
</mrow>
r和表示地球轨道航天器的位置矢量和速度矢量，rx,ry,rz表示位置矢量的三个分量，vx,vy,vz表示速度矢量的三个分量。
3.根据权利要求1所述的一种基于非线性H∞滤波的航天器自主定位方法，其特征在于：所述步骤(2)中脉冲到达时间观测量为：
yt＝h(xt)+vt
其中，
<mrow>
<mi>h</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msubsup>
<mi>t</mi>
<mi>b</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msubsup>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mi>c</mi>
</mfrac>
<msup>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<msub>
<mi>r</mi>
<mrow>
<mi>o</mi>
<mi>b</mi>
<mi>s</mi>
</mrow>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mn>2</mn>
<msubsup>
<mi>cD</mi>
<mn>0</mn>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msubsup>
</mrow>
</mfrac>
<mo>&lsqb;</mo>
<msubsup>
<mi>r</mi>
<mrow>
<mi>o</mi>
<mi>b</mi>
<mi>s</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<msub>
<mi>r</mi>
<mrow>
<mi>o</mi>
<mi>b</mi>
<mi>s</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>&rsqb;</mo>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>&mu;</mi>
<mi>s</mi>
</msub>
</mrow>
<msup>
<mi>c</mi>
<mn>3</mn>
</msup>
</mfrac>
<mi>l</mi>
<mi>n</mi>
<mo>|</mo>
<mrow>
<mfrac>
<mrow>
<msup>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<msub>
<mi>r</mi>
<mrow>
<mi>o</mi>
<mi>b</mi>
<mi>s</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mrow>
<mi>o</mi>
<mi>b</mi>
<mi>s</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msup>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>p</mi>
<mo>)</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>b</mi>
<mo>+</mo>
<mi>b</mi>
</mrow>
</mfrac>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>|</mo>
</mrow>
yt表示脉冲到达时间观测量，h(xt)为中间变量，vt表示测量噪声，表示脉冲信号到达太阳系质心SSB的时间，根据脉冲星时间模型预测得到；c表示光速，n(p)表示脉冲星视线矢量，表示SSB到脉冲星的距离，b是SSB相对于太阳质心的位置矢量，b为SSB相对于太阳质心的距离，μs是太阳引力常数，robs是地球轨道航天器相对于SSB的位置矢量，其计算公式为
robs＝re+r
其中，re表示地球中心相对于SSB的位置矢量。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510158859.XA CN104864875B (zh) | 2015-04-03 | 2015-04-03 | 一种基于非线性h∞滤波的航天器自主定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510158859.XA CN104864875B (zh) | 2015-04-03 | 2015-04-03 | 一种基于非线性h∞滤波的航天器自主定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104864875A CN104864875A (zh) | 2015-08-26 |
| CN104864875B true CN104864875B (zh) | 2018-01-05 |
Family
ID=53910877
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510158859.XA Active CN104864875B (zh) | 2015-04-03 | 2015-04-03 | 一种基于非线性h∞滤波的航天器自主定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104864875B (zh) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107340715B (zh) * | 2017-06-27 | 2020-08-25 | 北京电子工程总体研究所 | 一种返回式飞行器离轨制动期间的轨控容错控制方法 |
| CN109682383B (zh) * | 2018-11-23 | 2022-11-04 | 中国西安卫星测控中心 | 一种使用深空三向测量距离和数据的实时滤波定位方法 |
| CN109631913A (zh) * | 2019-01-30 | 2019-04-16 | 西安电子科技大学 | 基于非线性预测强跟踪无迹卡尔曼滤波的x射线脉冲星导航定位方法及系统 |
| CN112284329A (zh) * | 2020-10-22 | 2021-01-29 | 中国空间技术研究院 | 一种脉冲星角位置x射线强度关联测量的地面实验系统 |
| CN113074741B (zh) * | 2021-03-18 | 2023-04-25 | 中国人民解放军火箭军工程大学 | 一种脉冲星方位误差估计的增广状态算法 |
Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101038169A (zh) * | 2007-02-13 | 2007-09-19 | 北京空间飞行器总体设计部 | 基于x射线脉冲星的导航卫星自主导航系统与方法 |
| CN101178312A (zh) * | 2007-12-12 | 2008-05-14 | 南京航空航天大学 | 基于多信息融合的航天器组合导航方法 |
| CN102175246A (zh) * | 2010-12-31 | 2011-09-07 | 北京航空航天大学 | 一种x脉冲星探测器等效器的航天器导航系统 |
| CN103234538A (zh) * | 2013-04-07 | 2013-08-07 | 北京理工大学 | 一种行星最终接近段自主导航方法 |
| CN103389099A (zh) * | 2013-07-26 | 2013-11-13 | 西安电子科技大学 | 基于x射线脉冲星的航天器姿态和位置测量系统及方法 |
| CN103674020A (zh) * | 2012-09-04 | 2014-03-26 | 西安电子科技大学 | 一种基于x射线脉冲星的星座定向仿真系统及方法 |
| CN103674032A (zh) * | 2012-09-04 | 2014-03-26 | 西安电子科技大学 | 融合脉冲星辐射矢量和计时观测的卫星自主导航系统及方法 |
| CN103900577A (zh) * | 2014-04-14 | 2014-07-02 | 武汉科技大学 | 一种面向编队飞行的相对导航测速及组合导航方法 |
| CN103940424A (zh) * | 2014-04-14 | 2014-07-23 | 中国人民解放军国防科学技术大学 | 一种x射线脉冲星导航信号整周模糊度检测与估计方法 |
| CN103954279A (zh) * | 2014-05-19 | 2014-07-30 | 武汉科技大学 | 多普勒差分测速模型及与x射线脉冲星组合导航的方法 |
| CN104006813A (zh) * | 2014-04-03 | 2014-08-27 | 中国人民解放军国防科学技术大学 | 一种高轨卫星的脉冲星/星光角距组合导航方法 |
-
2015
- 2015-04-03 CN CN201510158859.XA patent/CN104864875B/zh active Active
Patent Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101038169A (zh) * | 2007-02-13 | 2007-09-19 | 北京空间飞行器总体设计部 | 基于x射线脉冲星的导航卫星自主导航系统与方法 |
| CN101178312A (zh) * | 2007-12-12 | 2008-05-14 | 南京航空航天大学 | 基于多信息融合的航天器组合导航方法 |
| CN102175246A (zh) * | 2010-12-31 | 2011-09-07 | 北京航空航天大学 | 一种x脉冲星探测器等效器的航天器导航系统 |
| CN103674020A (zh) * | 2012-09-04 | 2014-03-26 | 西安电子科技大学 | 一种基于x射线脉冲星的星座定向仿真系统及方法 |
| CN103674032A (zh) * | 2012-09-04 | 2014-03-26 | 西安电子科技大学 | 融合脉冲星辐射矢量和计时观测的卫星自主导航系统及方法 |
| CN103234538A (zh) * | 2013-04-07 | 2013-08-07 | 北京理工大学 | 一种行星最终接近段自主导航方法 |
| CN103389099A (zh) * | 2013-07-26 | 2013-11-13 | 西安电子科技大学 | 基于x射线脉冲星的航天器姿态和位置测量系统及方法 |
| CN104006813A (zh) * | 2014-04-03 | 2014-08-27 | 中国人民解放军国防科学技术大学 | 一种高轨卫星的脉冲星/星光角距组合导航方法 |
| CN103900577A (zh) * | 2014-04-14 | 2014-07-02 | 武汉科技大学 | 一种面向编队飞行的相对导航测速及组合导航方法 |
| CN103940424A (zh) * | 2014-04-14 | 2014-07-23 | 中国人民解放军国防科学技术大学 | 一种x射线脉冲星导航信号整周模糊度检测与估计方法 |
| CN103954279A (zh) * | 2014-05-19 | 2014-07-30 | 武汉科技大学 | 多普勒差分测速模型及与x射线脉冲星组合导航的方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104864875A (zh) | 2015-08-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104864875B (zh) | 一种基于非线性h∞滤波的航天器自主定位方法 | |
| Rhudy et al. | Evaluation of matrix square root operations for UKF within a UAV GPS/INS sensor fusion application | |
| CN107421550B (zh) | 一种基于星间测距的地球-Lagrange联合星座自主定轨方法 | |
| Zhang et al. | Cubature Kalman filtering for relative spacecraft attitude and position estimation | |
| CN102878995B (zh) | 一种静止轨道卫星自主导航方法 | |
| CN109931955B (zh) | 基于状态相关李群滤波的捷联惯性导航系统初始对准方法 | |
| CN103148849B (zh) | 基于地月卫星联合测距和紫外敏感器的组合导航方法 | |
| Pan et al. | An accurate calibration method for accelerometer nonlinear scale factor on a low-cost three-axis turntable | |
| CN104457705B (zh) | 基于天基自主光学观测的深空目标天体初定轨方法 | |
| CN111680462B (zh) | 基于空间目标在光学相平面位置变化的制导方法和系统 | |
| CN102998687A (zh) | 一种基于地球卫星和月球卫星联合测距的自主导航方法 | |
| CN107144283A (zh) | 一种用于深空探测器的高可观度光学脉冲星混合导航方法 | |
| Cao et al. | A novel unscented predictive filter for relative position and attitude estimation of satellite formation | |
| CN112985421A (zh) | 一种基于角度约束辅助测量的航天器自主天文导航方法 | |
| Izadi et al. | Rigid body motion estimation based on the Lagrange-d'Alembert principle | |
| Babcock | CubeSat attitude determination via Kalman filtering of magnetometer and solar cell data | |
| CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的系统 | |
| Liu et al. | Multi-UAV cooperative navigation algorithm based on federated filtering structure | |
| Lu et al. | A high-accuracy two-position alignment inertial navigation system for lunar rovers aided by a star sensor with a calibration and positioning function | |
| CN107830856B (zh) | 面向编队飞行的太阳tdoa量测方法及组合导航方法 | |
| Xiaoqian et al. | Nonlinear Extended Kalman Filter for Attitude Estimation of the Fixed‐Wing UAV | |
| Yu et al. | SINS/CNS nonlinear integrated navigation algorithm for hypersonic vehicle | |
| Hajiyev et al. | Integration of algebraic method and EKF for attitude determination of small information satellites | |
| Gao et al. | Autonomous orbit determination for Lagrangian navigation satellite based on neural network based state observer | |
| Olson | Sequential estimation methods for small body optical navigation |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| EXSB | Decision made by sipo to initiate substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |