CN103344244A - 火星大气进入段消除测量数据中***误差的两步滤波方法 - Google Patents
火星大气进入段消除测量数据中***误差的两步滤波方法 Download PDFInfo
- Publication number
- CN103344244A CN103344244A CN2013102857537A CN201310285753A CN103344244A CN 103344244 A CN103344244 A CN 103344244A CN 2013102857537 A CN2013102857537 A CN 2013102857537A CN 201310285753 A CN201310285753 A CN 201310285753A CN 103344244 A CN103344244 A CN 103344244A
- Authority
- CN
- China
- Prior art keywords
- error
- formula
- aircraft
- state
- measurement
- 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.)
- Granted
Links
Images
Landscapes
- Navigation (AREA)
Abstract
Description
技术领域
本发明涉及火星大气进入段消除测量数据中***误差的两步滤波方法。属于航天导航技术领域。
背景技术
火星大气进入段是整个火星进入、下降、着陆阶段不确定因素最多,状态变化最快,气动环境最复杂、精确着陆任务,火星大气进入段对着陆精度影响最大的阶段,因此要实现飞行器的精确状态估计是必须得到保证的。未来采样返回与载人登陆等火星任务要求着陆误差不超过1km,对火星大气进入段导航精度的要求势必会更高,故有必要对火星大气进入段的导航算法进行研究。然而,决定火星大气进入段导航精度有两个先决条件:
一、火星大气进入段导航滤波的动力学模型必须精确;
二、高精度的传感器和进入导航算法。
滤波方法是非常常见的一种确定飞行器状态估计的方法。传统的滤波方法要求动力学***和量测***的精确已知。但是,在实际工程应用中动力学***和量测***很难精确得到。在火星大气进入段中,由于飞行器初始进入界面的状态具有不确定性,动力学模型中的时变参数具有不确定性,大气密度具有不确定性,飞行器本身特性具有不确定性等等不确定性。这些不确定性导致动力学***很难精确得到,具有未知的偏差输入。另外现有量测手段有限,现有的可以应用于火星大气进入段的量测手段有惯性导航量测方法和无线电测距方法,使得量测***存在未知的量测***误差,例如无线电测距信标误差、无线电信号传递误差以及接收误差。这些动力学***偏差和测量***中的未知测量***误差对确定飞行器的最终状态影响很大,过大的偏差和误差会导致状态误差的增大甚至发散,引起飞行器的导航误差、降低导航精度。
基于以上的实际情况,建立了火星大气进入段消除测量数据中***误差的两步滤波方法,该方法对滤波量测***的未知误差不敏感,可以很好地应用于火星大气进入段飞行器的状态精确估计以满足未来火星的探测任务。
发明内容
1、目的:本发明的目的是提供一种火星大气进入段消除测量数据中***误差的两步滤波方法,以减小飞行器状态估计误差,提高其状态估计精度。
2、技术方案:本发明的目的是通过以下技术方案来实现的。
本发明一种火星大气进入段消除测量数据中***误差的两步滤波方法,其步骤如下:
步骤一、建立基于火星大气进入段飞行器的工程实际方程:离散时间下的动力学***和量测***
xk+1=f(xk)+Bkuk+wk (1)
zk=h(xk)+Hkdk+vk (2)
其中xk表示***状态量,zk是测量***测量值,uk是状态方程的确定性控制项,dk是未知的量测***误差;非线性方程f(·)和h(·)分别是状态转移方程和量测方程并且关于xk可微;矩阵Bk和Hk具有恰当的维数;wk和vk分别是动力学***噪声向量和量测噪声向量,其方差阵分别为Qk和Rk,它们是不相关的高斯白噪声满足以下式子:
步骤三、两步滤波方法:
(1)、未知的量测***误差估计
其中
式中,为tk时刻的新息均方误差估计,Mk为tk时刻的未知的量测***误差的滤波增益,为tk时刻的未知的量测***误差的估计,为状态的一步预测,zk为tk时刻的量测数据,为tk时刻状态估计的均方误差,为tk时刻未知量测***误差估计的均方误差,Ck为量测阵;
(2)、更新
(a)、量测更新
(b)、时间更新
其中
式中,Ak为tk-1时刻到tk时刻的一步转移矩阵,Gk为常数矩阵,在状态方程中无未知输入的情况下,即在此情况下,Gk取为0矩阵;
步骤四、令k=k+1,返回步骤三往下进行。直到k等于火星大气进入时间截止对应的时刻T时,至此完成火星大气进入段消除测量数据中***误差的两步滤波方法。
其中,步骤一中要根据实际情况合理建立相应的矩阵Bk和Hk。其中非线性方程f(·)和h(·)关于xk可微是指,xk是函数f(·)和h(·)定义域上的一点,且f(xk)和h(xk)的导数有定义。且式(3)中δkj是克罗内克函数,在数学中,克罗内克函数δkj是一个二元函数,克罗内克函数的自变量(输入值)一般是两个整数,如果两者相等,则其输出值为1,否则为0。
其中,在步骤一中所述的“建立基于火星大气进入段飞行器的工程实际方程”,其步骤如下:
飞行器沿飞行轨迹进入火星大气,其对应的简化动力学***为如下方程:
L,D分别是气动升力和助力定义为式:其中CL和CD为升力系数和阻力系数。火星大气密度ρ近似满足指数表达形式,其表达形式为而ρ0为参考密度,hs为火星大气标高,大小为7500m,rs为距离火星表面40km的火星参考径向半径,大小为3437.2km。
目前火星进入段的量测方式主要靠加速度计和陀螺仪,另外有学者提出可以考虑现有在轨的国外三颗通信卫星进行测量导航。由于目前状态下无法形成有效的导航网,量测***存在未知的量测***误差。其对应的量测***可以表示为:
其中是无线电测量值,R是飞行器与通信卫星间的真实距离,r是飞行器在火星中心惯性坐标系下的位置,ri是第i个通信卫星在火星中心惯性坐标系下的位置,aR是未知的量测***误差。
1)火星大气进入段对应的离散动力学***可以改写为如下形式:
xk+1=f(xk)+Bkuk+wk (20)
其中xk为火星大气进入段动力学***中的状态量包含式(16)中的左边的各分量,飞行器到火星中心的距离r,飞行器的速度v,经度θ,是纬度λ,飞行路径角γ,航向角ψ。Bk为对应的动力学***控制量对动力学***的驱动阵,uk是控制量对应于滚转角σ。
2)对应的离散量测方程为
zk=h(xk)+ax+vk (21)
其中
其中,步骤二中根据实际情况估计初值。在火星大气进入段之前,飞行器状态估计值和估计均方误差由大气层外飞行器飞行段末端得到。需要特别强调的是,飞行器初始状态估计值要是无偏的。
其中,步骤三中由式(14)可以发现,虽然Gk=0,但是Ak的行数应该和Gk的行数保持一致,而Gk的列数应该和dk的行数保持一致。
3、优点和功效:
本发明统筹考虑了火星实际大气进入过程中,非线性、非高斯随机***在量测***存在***误差条件下的飞行器状态估计问题。通过应用消除测量数据中***误差的两步滤波方法,飞行器在火星大气进入段,该方法不仅可以估计出量测***的测量数据中存在的***误差,而且可以运用估计出来的测量数据中存在的***误差来更好的估计出飞行器的状态。通过计算机仿真验证,该方法对***的状态可以进行精确的估计,其中飞行器的位置误差可以达到10m,飞行器的速度误差可以达到1m/s。因此该方法可以很好的满足未来火星探测任务的着陆误差精度要求。
附图说明
图1为非线性增量***的概率密度函数图解模型
图2为大气进入段飞行器扩展卡尔曼滤波方法与消除测量数据中***误差的两步方法状态估计误差比较
图3为火星大气进入段的消除测量数据中***误差的两步滤波方法具体实施的流程图
图中的代号、符号说明如下:
EKF为扩展卡尔曼滤波方法。
ERTSF为消除测量数据中***误差的两步滤波方法。
xk为状态向量。
uk是状态方程的确定性控制项。
dk是未知的量测***误差。
非线性方程f(·)和h(·)分别是状态转移方程和量测方程。
zk为量测向量。
矩阵Bk和Hk分别是控制向量驱动阵和量测阵。。
wk和vk分别是动力学***噪声向量和量测噪声向量
具体实施方式
见图3,本发明一种火星大气进入段消除测量数据中***误差的两步滤波方法,其具体实施步骤如下:
飞行器沿飞行轨迹进入火星大气,其对应的简化动力学***为如下方程。
L,D分别是气动升力和助力定义为式:其中CL和CD为升力系数和阻力系数。火星大气密度ρ近似满足指数表达形式,其表达形式为而ρ0为参考密度,hs为火星大气标高,大小为7500m,rs为距离火星表面40km的火星参考径向半径,大小为3437.2km。
目前火星进入段的量测方式主要靠加速度计和陀螺仪,另外有学者提出可以考虑现有在轨的国外三颗通信卫星(见图1)进行测量导航。由于目前状态下无法形成有效的导航网,量测***存在未知的量测***误差。其对应的量测***可以表示为:
其中是无线电测量值,R是飞行器与通信卫星间的真实距离,r是飞行器在火星中心惯性坐标系下的位置,ri是第i个通信卫星在火星中心惯性坐标系下的位置,aR是未知的量测***误差。
步骤一:建立工程实际方程:火星大气进入段对应的离散动力学***可以改写为如下形式:
xk+1=f(xk)+Bkuk+wk (28)
其中xk为火星大气进入段动力学***中的状态量包含式(24)中的左边的各分量,飞行器到火星中心的距离r,飞行器的速度v,经度θ,是纬度λ,飞行路径角γ,航向角ψ。Bk为对应的动力学***控制量对动力学***的驱动阵,uk是控制量对应于滚转角σ。
对应的离散量测方程为
zk=h(xk)+ax+vk (29)
其中
步骤二、给定初始值:
初始值为飞行器在大气外飞行末端(即大气进入界面)状态估计得到,如表一
表一火星大气进入的初始量及真实量
其中真实量为提前规划的火星大气进入点。实际上也存在一定的不确定性。初始状态估计均方误差
三个通信信标的初始位置如表二,而惯性导航和无线电测距的未知量测***误差如表三。
表二火星表面通信信标的初始位置
表三未知量测***误差
步骤三、两步滤波方法:
(1)、未知的量测***误差估计
其中动力学***噪声方差阵为 量测噪声方差阵为 并且根据实际的量测***选取相应的矩阵。当三个加速度计***误差一样,三颗卫星到飞行器的无线电测量***误差一样,则得到相应矩阵 对于每个加速度计、无线电测量***误差可以重新设置相应的矩阵。
按照公式(4)-(8)进行滤波,对火星大气进入段未知的量测***误差以及未知量测***误差估计的均方误差进行估计。
(2)、更新
(a)、量测更新
按照式(9)-式(12)对***进行量测估计,包括对状态估计,状态估计的均方误差以及状态估计与未知量测***误差估计的协方差进行更新。
(b)、时间更新
按照式(13)-式(15)对***进行时间更新,包括对状态估计的一步预测均方误差和状态的一步预测进行更新。
步骤四、令k=k+1,返回步骤三往下进行。直到k等于火星大气进入时间截止对应的时刻T时,至超音速降落伞打开为止。至此完成火星大气进入段消除测量数据中***误差的两步滤波方法。
其中截止时间主要取决于飞行器与火星表面的高度及速度,能否满足超音速降落伞打开。
从图2可以看出,在相同的初始条件下,消除测量数据中***误差的两步滤波方法得到的状态估计比扩展卡尔曼滤波的精度高,能够消除***误差对滤波的影响,提高滤波的稳定性。由于火星大气进入段飞行器与火星表面的高度及速度对于超音速降落伞打开的重要性,所以有必要对火星大气进入段飞行器与火星表面的高度及速度的估计精度进行进一步的研究。从图2的子图1和子图2可以看出,消除测量数据中***误差的两步滤波方法给出的火星大气进入段飞行器与火星表面的高度及速度的估计误差精度相对于由扩展卡尔曼滤波方法给出的估计误差精度提高了很多。可以进一步看出,消除测量数据中***误差的两步滤波方法相对于扩展卡尔曼滤波的优越性。
以上所述仅为本发明较佳的实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化和替换都应涵盖在本发明的保护范围之内,另外本发明提供的方法可以集成到火星大气进入飞行器位置速度估计软件中。
Claims (2)
1.一种火星大气进入段消除测量数据中***误差的两步滤波方法,其特征在于:其步骤如下:
步骤一、建立基于火星大气进入段飞行器的工程实际方程:离散时间下的动力学***和量测***
xk+1=f(xk)+Bkuk+wk (1)
zk=h(xk)+Hkdk+vk (2)
其中xk表示***状态量,zk是测量***测量值,uk是状态方程的确定性控制项,dk是未知的量测***误差;非线性方程f(·)和h(·)分别是状态转移方程和量测方程并且关于xk可微;矩阵Bk和Hk具有恰当的维数;wk和vk分别是动力学***噪声向量和量测噪声向量,其方差阵分别为Qk和Rk,它们是不相关的高斯白噪声满足以下式子:
步骤三、两步滤波方法:
(1)、未知的量测***误差估计
其中,
式中,为tk时刻的新息均方误差估计,Mk为tk时刻的未知的量测***误差的滤波增益,为tk时刻的未知的量测***误差的估计,为状态的一步预测,zk为tk时刻的量测数据,为tk时刻状态估计的均方误差,为tk时刻未知量测***误差估计的均方误差,Ck为量测阵;
(2)、更新
(a)、量测更新
(b)、时间更新
其中
式中,Ak为tk-1时刻到tk时刻的一步转移矩阵,Gk为常数矩阵,在状态方程中无未知输入的情况下,即在此情况下,Gk取为0矩阵;
步骤四、令k=k+1,返回步骤三往下进行,直到k等于火星大气进入时间截止对应的时刻T时,至此完成火星大气进入段消除测量数据中***误差的两步滤波方法。
2.根据权利要求1所述的一种火星大气进入段消除测量数据中***误差的两步滤波方法,其特征在于:在在步骤一中所述的“建立基于火星大气进入段飞行器的工程实际方程”,其步骤如下:
飞行器沿飞行轨迹进入火星大气,其对应的简化动力学***为如下方程:
L,D分别是气动升力和助力定义为式:其中CL和CD为升力系数和阻力系数;火星大气密度ρ近似满足指数表达形式,其表达形式为而ρ0为参考密度,hs为火星大气标高,大小为7500m,rs为距离火星表面40km的火星参考径向半径,大小为3437.2km;
由于目前状态下无法形成有效的导航网,量测***存在未知的量测***误差,其对应的量测***表示为:
1)火星大气进入段对应的离散动力学***改写为如下形式:
xk+1=f(xk)+Bkuk+wk (20)
其中xk为火星大气进入段动力学***中的状态量包含式(16)中的左边的各分量,飞行器到火星中心的距离r,飞行器的速度v,经度θ,是纬度λ,飞行路径角γ,航向角ψ,Bk为对应的动力学***控制量对动力学***的驱动阵,uk是控制量对应于滚转角σ;
2)对应的离散量测方程为
zk=h(xk)+ax+vk (21)
其中
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310285753.7A CN103344244B (zh) | 2013-07-09 | 2013-07-09 | 火星大气进入段消除测量数据中***误差的两步滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310285753.7A CN103344244B (zh) | 2013-07-09 | 2013-07-09 | 火星大气进入段消除测量数据中***误差的两步滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103344244A true CN103344244A (zh) | 2013-10-09 |
CN103344244B CN103344244B (zh) | 2015-12-23 |
Family
ID=49279060
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310285753.7A Expired - Fee Related CN103344244B (zh) | 2013-07-09 | 2013-07-09 | 火星大气进入段消除测量数据中***误差的两步滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103344244B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104266650A (zh) * | 2014-10-25 | 2015-01-07 | 哈尔滨工业大学 | 一种基于采样点继承策略的火星着陆器大气进入段导航方法 |
CN105300387A (zh) * | 2015-11-03 | 2016-02-03 | 北京航空航天大学 | 一种火星大气进入段非线性非高斯秩滤波方法 |
CN106742069A (zh) * | 2016-12-29 | 2017-05-31 | 北京理工大学 | 一种火星大气进入段最优预测制导方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030187623A1 (en) * | 2002-03-06 | 2003-10-02 | Bayard David S. | High accuracy inertial sensors from inexpensive components |
CN101672651A (zh) * | 2009-09-25 | 2010-03-17 | 北京航空航天大学 | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 |
CN102353378A (zh) * | 2011-09-09 | 2012-02-15 | 南京航空航天大学 | 一种矢量形式信息分配系数的自适应联邦滤波方法 |
-
2013
- 2013-07-09 CN CN201310285753.7A patent/CN103344244B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030187623A1 (en) * | 2002-03-06 | 2003-10-02 | Bayard David S. | High accuracy inertial sensors from inexpensive components |
CN101672651A (zh) * | 2009-09-25 | 2010-03-17 | 北京航空航天大学 | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 |
CN102353378A (zh) * | 2011-09-09 | 2012-02-15 | 南京航空航天大学 | 一种矢量形式信息分配系数的自适应联邦滤波方法 |
Non-Patent Citations (2)
Title |
---|
***等: "增量粒子滤波方法", 《航空动力学报》, vol. 28, no. 6, 30 June 2013 (2013-06-30) * |
王文强: "火星探测中进入弹道与大气模型重建", 《航天返回与遥感》, vol. 34, no. 2, 30 April 2013 (2013-04-30) * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104266650A (zh) * | 2014-10-25 | 2015-01-07 | 哈尔滨工业大学 | 一种基于采样点继承策略的火星着陆器大气进入段导航方法 |
CN104266650B (zh) * | 2014-10-25 | 2016-11-02 | 哈尔滨工业大学 | 一种基于采样点继承策略的火星着陆器大气进入段导航方法 |
CN105300387A (zh) * | 2015-11-03 | 2016-02-03 | 北京航空航天大学 | 一种火星大气进入段非线性非高斯秩滤波方法 |
CN105300387B (zh) * | 2015-11-03 | 2018-04-10 | 北京航空航天大学 | 一种火星大气进入段非线性非高斯秩滤波方法 |
CN106742069A (zh) * | 2016-12-29 | 2017-05-31 | 北京理工大学 | 一种火星大气进入段最优预测制导方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103344244B (zh) | 2015-12-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105300387B (zh) | 一种火星大气进入段非线性非高斯秩滤波方法 | |
CN103245359B (zh) | 一种惯性导航***中惯性传感器固定误差实时标定方法 | |
CN105737823A (zh) | 基于五阶ckf的gps/sins/cns组合导航方法 | |
Dorobantu et al. | An airborne experimental test platform: From theory to flight | |
CN103727941A (zh) | 基于载体系速度匹配的容积卡尔曼非线性组合导航方法 | |
CN104764467A (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN103344260A (zh) | 基于rbckf的捷联惯导***大方位失准角初始对准方法 | |
CN105865446A (zh) | 基于大气辅助的惯性高度通道阻尼卡尔曼滤波方法 | |
CN103900574A (zh) | 一种基于迭代容积卡尔曼滤波姿态估计方法 | |
CN103727940A (zh) | 基于重力加速度矢量匹配的非线性初始对准方法 | |
CN105136166A (zh) | 一种指定惯导位置精度的捷联惯导误差模型仿真方法 | |
CN103884340A (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
CN103708045A (zh) | 一种探月飞船跳跃式再入的在线参数辨识方法 | |
CN104215244A (zh) | 基于发射惯性坐标系的空天飞行器组合导航鲁棒滤波方法 | |
CN103218482A (zh) | 一种动力学***中不确定参数的估计方法 | |
CN103344244A (zh) | 火星大气进入段消除测量数据中***误差的两步滤波方法 | |
CN103344245A (zh) | 火星进入段imu和甚高频无线电组合导航的ud-skf方法 | |
EP4033205A1 (en) | Systems and methods for model based vehicle navigation | |
Oh et al. | Extended Kalman filter with multi-frequency reference data for quadrotor navigation | |
CN103323009B (zh) | 火星大气进入段的非线性三步滤波方法 | |
CN103344246B (zh) | 火星动力下降段减弱动力学***误差的两步滤波方法 | |
CN103901459A (zh) | 一种mems/gps组合导航***中量测滞后的滤波方法 | |
Gu et al. | A Kalman filter algorithm based on exact modeling for FOG GPS/SINS integration | |
CN103411627B (zh) | 火星动力下降段非线性三步滤波方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20151223 Termination date: 20170709 |
|
CF01 | Termination of patent right due to non-payment of annual fee |