CN101762272A - 一种基于可观测度分析的深空自主导航方法 - Google Patents
一种基于可观测度分析的深空自主导航方法 Download PDFInfo
- Publication number
- CN101762272A CN101762272A CN201010032483A CN201010032483A CN101762272A CN 101762272 A CN101762272 A CN 101762272A CN 201010032483 A CN201010032483 A CN 201010032483A CN 201010032483 A CN201010032483 A CN 201010032483A CN 101762272 A CN101762272 A CN 101762272A
- Authority
- CN
- China
- Prior art keywords
- sight line
- earth
- line vector
- autonomous
- deep
- 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.)
- Pending
Links
Images
Landscapes
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
Abstract
一种基于可观测度分析的深空自主导航方法,涉及航天航空领域。本发明为解决现有自主导航系统综合利用不同观测模型提供测量信息时,需要处理不同传感器不同类型的测量信息,从而导致观测信息的利用率降低,同时降低了自主导航系统的自适应能力和可靠性的问题,该方法建立在地月转移轨道深空探测器动力学模型的基础上,利用非线性系统可观测度分析方法给出地心视线矢量和月心视线矢量两种观测模型下深空自主导航系统的可观测度,采用基于UKF联邦滤波算法获得深空探测器的轨道参数。本发明适用于深空分离段、转移段探测器轨道参数的确定。本发明可用于提高深空自主导航系统的精度和可靠性,特别适用于多种观测模型下的信息融合自主导航技术。
Description
技术领域
本发明涉及一种深空探测器自主轨道确定方法,属于航天航空领域。
背景技术
自主导航技术是目前深空探测任务的研究热点。自主导航是指探测器在不依赖地面站的条件下,仅依靠星载测量设备实时地确定探测器的位置、速度以及其它参数,是探测器自主运行技术的重要组成部分和关键技术。自主导航技术能减少操作的复杂性,增强探测器的自主生存能力,并为姿态控制、机动规划和轨道控制等方面的自主能力提供支持,从而扩展深空探测器的空间应用潜力。
随着航天技术的发展,深空探测任务的科学目的和实施方式逐渐趋向多元化,这给自主导航系统提出了更高的要求。为了得到高精度的轨道参数估计结果,深空探测器上往往配置多种类型的导航敏感器,自主导航系统需要处理不同传感器不同类型的测量信息。导致不同类型的观测信息的利用率降低,同时降低了自主导航系统的自适应能力和可靠性,如何通过信息融合技术综合利用各种测量信息,提高自主导航系统的可靠性和鲁棒性是当前深空自主导航技术面临的一个重要研究方向。
发明内容
本发明的目的是为解决现有自主导航系统综合利用不同观测模型提供测量信息时,需要处理不同传感器不同类型的测量信息,从而导致观测信息的利用率降低,同时降低了自主导航系统的自适应能力和可靠性的问题,提出了一种基于可观测度分析的深空自主导航方法。它的具体步骤为:
步骤一:建立深空探测器基于地月转移轨道动力学模型的深空自主导航系统的状态模型;
步骤二:建立深空探测器基于地月转移轨道的地心视线矢量观测模型和月心视线矢量观测模型;
步骤三:采用非线性系统可观测度分析方法对步骤一的自主导航系统的状态模型与步骤二获得的地心视线矢量观测模型和月心视线矢量观测模型进行分析;获得地心视线矢量观测模型下自主导航系统的可观测度和月心视线矢量观测模型下自主导航系统的可观测度;
步骤四:对步骤三获得的地心视线矢量观测模型下自主导航系统的可观测度和月心视线矢量观测模型下自主导航系统的可观测度分别进行动态确定信息分配因子;
步骤五:根据步骤四获得的信息分配因子,采用基于UKF的联邦滤波算法获得深空探测器的轨道参数;
步骤六:根据步骤五获得的深空控测器的轨道参数,实现深空自主导航。
本发明的有益效果:采用本发明方法的自主导航系统不需要处理不同传感器不同类型的测量信息,本发明为多种类型导航传感器下不同观测模型的信息融合技术提供一种有效途径;本发明利用不同观测模型对应的自主导航系统的可观测度动态确定信息分配因子,能够直观地反映观测时刻子系统的估计精度,提高了不同观测信息的利用率,进而提高了导航系统的自适应能力和可靠性。
附图说明
图1为本发明方法的流程图;图2为具体实施方式三所述的地心视线矢量和月心视线矢量的观测模型示意图;图3为本发明方法获得深空自主导航系统的轨道位置估计误差曲线,图4为本发明方法获得深空自主导航系统的轨道速度估计误差曲线。
具体实施方式
具体实施方式一:结合图1说明本实施方式,本实施方式所述的一种基于可观测度分析的深空自主导航方法,具体步骤为:
步骤一:建立深空探测器基于地月转移轨道动力学模型的深空自主导航系统的状态模型;
步骤二:建立深空探测器基于地月转移轨道的地心视线矢量观测模型和月心视线矢量观测模型;
步骤三:采用非线性系统可观测度分析方法对步骤一的自主导航系统的状态模型与步骤二获得的地心视线矢量观测模型和月心视线矢量观测模型进行分析;获得地心视线矢量观测模型下自主导航系统的可观测度和月心视线矢量观测模型下自主导航系统的可观测度;
步骤四:对步骤三获得的地心视线矢量观测模型下自主导航系统的可观测度和月心视线矢量观测模型下自主导航系统的可观测度分别进行动态确定信息分配因子;
步骤五:根据步骤四获得的信息分配因子,采用基于UKF的联邦滤波算法获得深空探测器的轨道参数;
步骤六:根据步骤五获得的深空控测器的轨道参数,实现深空自主导航。
本实施方式步骤五所述的采用基于UKF的联邦滤波算法获得深空探测器的轨道参数,避免了对状态方程和观测方程的线性化,不存在高阶项截断误差,提高了子系统的滤波精度和稳定性,进而极大地改善了自主导航系统的性能。
具体实施方式二:本实施方式与实施方式一所述的一种基于可观测度分析的深空自主导航方法的不同之处在于,步骤一中所述的深空自主导航系统的状态模型为:
式中,r=[xyz]T为探测器在惯性系统内的位置,v=[vxvyvz]T为探测器在惯性系统内的速度,X=[rTvT]T为系统状态变量;μ为地球引力常数,J2为地球形状摄动引力系数,Rc为地球平均赤道半径;其中xm,ym,zm为月球在惯性系内的位置分量,rm为月球在惯性系内的矢径;rsm为月球相对于探测器的矢径;w为系统模型误差,上述深空自主导航系统的状态模型也称深空自主导航的状态方程。
本实施方式所述的深空自主导航系统的状态模型建立在J2000地心赤道惯性坐标系中,涉及参数为地球形状摄动引力系数J2和月球引力。
具体实施方式三:结合图2说明本实施方式,本实施方式与实施方式一所述的一种基于可观测度分析的深空自主导航方法的不同之处在于步骤二所述的地心视线矢量观测模型和月心视线矢量观测模型,其表达式如下:
所述地心视线矢量观测模型为
式中,Θe为地心方向高度角,Φe为地心方位角;
月心视线矢量观测模型为
式中,Θm为月心方向高度角,Φm为月心方位角。
本实施方式分别以地心视线矢量和月心视线矢量为量测的观测方程,姿态控制系统提供视线矢量测量所需要的姿态信息,所述地心视线矢量观测方程为
式中,Θe为地心方向高度角,Φe为地心方位角,ve1和ve2为观测误差;ve为地心视线矢量的观测噪声矢量。
相应地,地心视线矢量le表示为
le=cos(Θe)cos(Φe)n1+cos(Θe)sin(Φe)n2+sin(Θe)n3
式中,n1,n2和n3分别为地心赤道惯性坐标系的坐标轴。
月心视线矢量观测方程为
式中,Θm为月心方向高度角,Φm为月心方位角,vm1和vm2为观测误差;vm为地心视线矢量的观测噪声矢量;
相应地,月心视线矢量lm表示为
lm=cos(Θm)cos(Φm)n1+cos(Θm)sin(Φm)n2+sin(Θm)n3。
具体实施方式四:本实施方式与实施方式一所述的一种基于可观测度分析的深空自主导航方法的不同之处在于,步骤三采用非线性系统可观测度分析方法分别给出地心视线矢量和月心视线矢量两种观测模型下自主导航系统的可观测度,通过微分几何相关理论推导出非线性系统的可观测矩阵,并利用条件数定义非线性系统的可观测度;然后,针对地心视线矢量和月心视线矢量两种观测模型所对应的深空自主导航系统,分别给出相应的深空自主导航系统的可观测度。
在不考虑轨道动力学模型误差和观测误差的情况下,所述深空自主导航系统可以表示为如下非线性系统
非线性系统的可观测矩阵为
式中,n为状态矢量X的维数;Lk fh(X)按如下方式定义
L0 fh(X)=h(X)
同时,dLk fh(X)定义如下
非线性系统的可观测度δ(X)定义为
式中,σmin为可观测矩阵Q的最大奇异值,σmax为可观测矩阵Q的最小奇异值;
将深空自主导航系统的状态方程和地心视线矢量的观测方程代入到非线性系统的可观测度定义中,并结合观测时刻的轨道参数预测值,得到地心视线矢量观测模型下深空自主导航系统的可观测度;同时,将深空自主导航系统的状态方程和月心视线矢量的观测方程代入到非线性系统的可观测度定义中,结合观测时刻的轨道参数预测值,可以得到月心视线矢量观测模型下深空自主导航系统的可观测度。
具体实施方式五:本实施方式与实施方式一所述的一种基于可观测度分析的深空自主导航方法的不同之处在于,步骤四所述的确定信息分配因子表示为:
式中,δ1(X)为地心视线矢量观测模型下自主导航系统的可观测度;δ2(X)为月心视线矢量观测模型下自主导航系统的可观测度。
具体实施方式六:本实施方式与实施方式一所述的一种基于可观测度分析的深空自主导航方法的不同之处在于,步骤五所述的采用基于UKF的联邦滤波算法,获得深空探测器1的自主导航系统的轨道参数;具体过程为:信息分配步骤:根据动态信息分配因子βi在各子滤波器之间分配系统的过程噪声Q和全局状态估计协方差阵Pg,即
式中,为k-1时刻的全局状态估计;为各子滤波器中k-1时刻的局部状态估计;Qi(k-1)为各子滤波器k-1时刻的的过程噪声;Pg(k-1)为k-1时刻的全局估计误差协方差阵;Pi(k-1)为各子滤波器中k-1时刻的局部估计误差协方差阵;
时间更新和测量更新步骤:时间更新和测量更新分别在各子滤波器中进行,采用UKF算法,滤波后得到k时刻的局部估计及k时刻局部估计误差协方差阵Pi(k);
所述局部估计信息包括局部状态估计和局部估计误差协方差阵。
本发明以地月转移轨道为例进行数学仿真;验证了本发明的效果;
仿真参数如下:
1)深空探测器1的标称轨道数据由STK软件生成;
本仿真过程考虑了地球非球形引力摄动、太阳引力摄动、月球引力摄动、大气阻力和太阳光压。
深空探测器1的初始位置[-3.282×1035.588×1031.165×103](km);
深空探测器1的初始速度[-7.836-2.664-7.124](km/s)。
2)仿真过程涉及的常数分别为:
地球引力常数μ=3.986×105km3/s2;
月球引力常数μm=4.887×103km3/s2;
地球平均赤道半径Re=6378km;
地球J2项系数J2=-1.08264×10-3
3)仿真过程测量的精度为:地心方向角与月心方向角的测量精度均为0.020(1σ);
4)仿真中深空探测器1的轨道初始位置误差为50km,初始速度误差为0.01km/s;
5)仿真实验的采样周期为5s。
从仿真结果中可以看出,深空自主导航算法滤波过程收敛速度较快,最终位置估计误差小于3km,速度估计误差小于0.2m/s,本发明提出的一种基于可观测度分析的深空自主导航方法满足地月转移轨道导航参数精度的要求。
Claims (5)
1.一种基于可观测度分析的深空自主导航方法,其特征是,它的具体步骤为:
步骤一:建立深空探测器基于地月转移轨道动力学模型的深空自主导航系统的状态模型;
步骤二:建立深空探测器基于地月转移轨道的地心视线矢量观测模型和月心视线矢量观测模型;
步骤三:采用非线性系统可观测度分析方法对步骤一的自主导航系统的状态模型与步骤二获得的地心视线矢量观测模型和月心视线矢量观测模型进行分析;获得地心视线矢量观测模型下自主导航系统的可观测度和月心视线矢量观测模型下自主导航系统的可观测度;
步骤四:对步骤三获得的地心视线矢量观测模型下自主导航系统的可观测度和月心视线矢量观测模型下自主导航系统的可观测度分别进行动态确定信息分配因子;
步骤五:根据步骤四获得的信息分配因子,采用基于UKF的联邦滤波算法获得深空探测器的轨道参数;
步骤六:根据步骤五获得的深空控测器的轨道参数,实现深空自主导航。
2.根据权利要求1所述的一种基于可观测度分析的深空自主导航方法,其特征在于步骤一中所述的深空自主导航系统的状态模型为:
式中,r=[x y z]T为探测器在惯性系统内的位置,v=[vx vy vz]T为探测器在惯性系统内的速度,X=[rTvT]T为系统状态变量;μ为地球引力常数,J2为地球形状摄动引力系数,Re为地球平均赤道半径;其中xm,ym,zm为月球在惯性系内的位置分量,rm为月球在惯性系内的矢径;rsm为月球相对于探测器的矢径;w为系统模型误差。
3.根据权利要求1所述的一种基于可观测度分析的深空自主导航方法,其特征在于步骤二所述的地心视线矢量观测模型和月心视线矢量观测模型,其表达式如下:
地心视线矢量观测模型为
式中,Θe为地心方向高度,Φe为地心方位角;
月心视线矢量观测模型为
式中,Θm为月心方向高度,Φm为月心方位角。
4.根据权利要求1所述的一种基于可观测度分析的深空自主导航方法,其特征在于步骤四所述的信息分配因子表示为:
式中,δ1(X)为地心视线矢量观测模型下自主导航系统的可观测度;δ2(X)为月心视线矢量观测模型下自主导航系统的可观测度。
5.根据权利要求1所述的一种基于可观测度分析的深空自主导航方法,其特征在于步骤五所述的采用基于UKF的联邦滤波算法获得深空探测器的自主导航系统的轨道参数的具体过程为:
信息分配步骤:根据动态信息分配因子βi在各子滤波器之间分配系统的过程噪声Q和全局状态估计协方差阵Pg,即
式中,为k-1时刻的全局状态估计;为各子滤波器中k-1时刻的局部状态估计;Qi(k-1)为各子滤波器k-1时刻的的过程噪声;Pg(k-1)为k-1时刻的全局估计误差协方差阵;Pi(k-1)为各子滤波器中k-1时刻的局部估计误差协方差阵;
信息融合步骤:在主滤波器中按照如下合成算法将各子滤波器的局部估计信息进行融合,得到k时刻的全局状态估计和k时刻的全局估计误差协方差阵Pg(k):
所述局部估计信息包括局部状态估计和局部估计误差协方差阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010032483A CN101762272A (zh) | 2010-01-18 | 2010-01-18 | 一种基于可观测度分析的深空自主导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010032483A CN101762272A (zh) | 2010-01-18 | 2010-01-18 | 一种基于可观测度分析的深空自主导航方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN101762272A true CN101762272A (zh) | 2010-06-30 |
Family
ID=42493574
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010032483A Pending CN101762272A (zh) | 2010-01-18 | 2010-01-18 | 一种基于可观测度分析的深空自主导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101762272A (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102252677A (zh) * | 2011-04-18 | 2011-11-23 | 哈尔滨工程大学 | 一种基于时间序列分析的变比例自适应联邦滤波方法 |
CN102997923A (zh) * | 2012-11-30 | 2013-03-27 | 北京控制工程研究所 | 一种基于多模型自适应滤波的自主导航方法 |
CN103076017A (zh) * | 2012-12-30 | 2013-05-01 | 北京理工大学 | 基于可观测度分析的火星进入段自主导航方案设计方法 |
CN103591956A (zh) * | 2013-11-27 | 2014-02-19 | 北京理工大学 | 一种基于可观测性分析的深空探测器自主导航方法 |
CN103870714A (zh) * | 2014-04-03 | 2014-06-18 | 武汉科技大学 | 一种基于高阶可观阵的导航系统可观测分析方法 |
CN103968844A (zh) * | 2013-02-04 | 2014-08-06 | 上海新跃仪表厂 | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 |
CN104296753A (zh) * | 2014-09-26 | 2015-01-21 | 北京控制工程研究所 | 一种基于多模型滤波的空间目标定位方法 |
CN106092092A (zh) * | 2016-06-02 | 2016-11-09 | 武汉科技大学 | 面向脉冲星导航系统的分数阶可观测性分析方法 |
CN108490966A (zh) * | 2018-01-31 | 2018-09-04 | 中国人民解放军国防科技大学 | 基于微分代数的静止轨道摄动相对轨迹高阶制导方法 |
CN109341725A (zh) * | 2018-12-06 | 2019-02-15 | 北京理工大学 | 行星接近段导航性能快速评估方法 |
CN113053106A (zh) * | 2021-03-05 | 2021-06-29 | 交通运输部公路科学研究所 | 基于多传感器信息融合的交通状态估计方法和装置 |
CN113589343A (zh) * | 2021-07-19 | 2021-11-02 | 中国科学院微小卫星创新研究院 | 一种基于月球成像敏感器的月心矢量和太阳方向提取方法 |
-
2010
- 2010-01-18 CN CN201010032483A patent/CN101762272A/zh active Pending
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102252677A (zh) * | 2011-04-18 | 2011-11-23 | 哈尔滨工程大学 | 一种基于时间序列分析的变比例自适应联邦滤波方法 |
CN102997923B (zh) * | 2012-11-30 | 2015-11-25 | 北京控制工程研究所 | 一种基于多模型自适应滤波的自主导航方法 |
CN102997923A (zh) * | 2012-11-30 | 2013-03-27 | 北京控制工程研究所 | 一种基于多模型自适应滤波的自主导航方法 |
CN103076017A (zh) * | 2012-12-30 | 2013-05-01 | 北京理工大学 | 基于可观测度分析的火星进入段自主导航方案设计方法 |
CN103076017B (zh) * | 2012-12-30 | 2015-04-15 | 北京理工大学 | 基于可观测度分析的火星进入段自主导航方案设计方法 |
CN103968844A (zh) * | 2013-02-04 | 2014-08-06 | 上海新跃仪表厂 | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 |
CN103591956A (zh) * | 2013-11-27 | 2014-02-19 | 北京理工大学 | 一种基于可观测性分析的深空探测器自主导航方法 |
CN103591956B (zh) * | 2013-11-27 | 2016-02-03 | 北京理工大学 | 一种基于可观测性分析的深空探测器自主导航方法 |
CN103870714A (zh) * | 2014-04-03 | 2014-06-18 | 武汉科技大学 | 一种基于高阶可观阵的导航系统可观测分析方法 |
CN103870714B (zh) * | 2014-04-03 | 2017-04-12 | 武汉科技大学 | 一种基于高阶可观阵的导航系统可观测分析方法 |
CN104296753A (zh) * | 2014-09-26 | 2015-01-21 | 北京控制工程研究所 | 一种基于多模型滤波的空间目标定位方法 |
CN106092092A (zh) * | 2016-06-02 | 2016-11-09 | 武汉科技大学 | 面向脉冲星导航系统的分数阶可观测性分析方法 |
CN106092092B (zh) * | 2016-06-02 | 2018-08-21 | 武汉科技大学 | 面向脉冲星导航系统的分数阶可观测性分析方法 |
CN108490966A (zh) * | 2018-01-31 | 2018-09-04 | 中国人民解放军国防科技大学 | 基于微分代数的静止轨道摄动相对轨迹高阶制导方法 |
CN108490966B (zh) * | 2018-01-31 | 2021-02-05 | 中国人民解放军国防科技大学 | 基于微分代数的静止轨道摄动相对轨迹高阶制导方法 |
CN109341725A (zh) * | 2018-12-06 | 2019-02-15 | 北京理工大学 | 行星接近段导航性能快速评估方法 |
CN113053106A (zh) * | 2021-03-05 | 2021-06-29 | 交通运输部公路科学研究所 | 基于多传感器信息融合的交通状态估计方法和装置 |
CN113589343A (zh) * | 2021-07-19 | 2021-11-02 | 中国科学院微小卫星创新研究院 | 一种基于月球成像敏感器的月心矢量和太阳方向提取方法 |
CN113589343B (zh) * | 2021-07-19 | 2023-07-25 | 中国科学院微小卫星创新研究院 | 一种基于月球成像敏感器的月心矢量和太阳方向提取方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101762272A (zh) | 一种基于可观测度分析的深空自主导航方法 | |
Giannitrapani et al. | Comparison of EKF and UKF for spacecraft localization via angle measurements | |
CN102878995B (zh) | 一种静止轨道卫星自主导航方法 | |
CN103917850B (zh) | 一种惯性导航系统的运动对准方法 | |
CN102175260B (zh) | 一种自主导航系统误差校正方法 | |
CN103148849B (zh) | 基于地月卫星联合测距和紫外敏感器的组合导航方法 | |
CN104236586B (zh) | 基于量测失准角的动基座传递对准方法 | |
CN103076017B (zh) | 基于可观测度分析的火星进入段自主导航方案设计方法 | |
CN102998687B (zh) | 一种基于地球卫星和月球卫星联合测距的自主导航方法 | |
CN105737828A (zh) | 一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法 | |
Dorobantu et al. | An airborne experimental test platform: From theory to flight | |
CN103884340B (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
Li et al. | Innovative Mars entry integrated navigation using modified multiple model adaptive estimation | |
CN103017772B (zh) | 一种基于可观性分析的光学和脉冲星融合自主导航方法 | |
Gao et al. | Rapid alignment method based on local observability analysis for strapdown inertial navigation system | |
Gebre-Egziabher et al. | MAV attitude determination by vector matching | |
CN103591956B (zh) | 一种基于可观测性分析的深空探测器自主导航方法 | |
CN103968834A (zh) | 一种近地停泊轨道上深空探测器的自主天文导航方法 | |
CN112161632A (zh) | 一种基于相对位置矢量测量的卫星编队初始定位算法 | |
Cork | Aircraft dynamic navigation for unmanned aerial vehicles | |
Zimmer et al. | Reducing orbit covariance for continuous thrust spacecraft transfers | |
CN103438892B (zh) | 一种改进的基于ekf的天文自主定轨算法 | |
CN103017773B (zh) | 一种基于天体表面特征和天然卫星路标的环绕段导航方法 | |
Elsergany et al. | Novel Augmented Quaternion UKF for Enhanced Loosely Coupled GPS/INS Integration | |
Li et al. | Simulation analysis for the influences of vehicle maneuvers to the attitude estimations of GNSS/INS navigation systems |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Open date: 20100630 |