一种基于多模型的火星大气进入容中断估计方法技术

本发明专利技术公开的一种基于多模型的火星大气进入容中断估计方法，涉及火星大气进入容中断估计方法，属于深空探测技术领域。本发明专利技术实施步骤为：步骤1：建立火星大气进入段动力学方程。步骤2：建立火星大气进入段无线电测量模型及无线电测量中断模型，用于步骤3对探测器位置和速度信息的修正。步骤3结合步骤2无线电模型及中断模型及滤波算法对探测器状态进行解算，估计出探测器的状态。本发明专利技术可有效抑制无线电测量中断下探测器状态估计发散问题，提高探测器在火星大气进入段的自主导航系统的可靠性及状态估计精度。本发明专利技术可为未来火星着陆探测中大气进入段采用无线电导航方案设计提供技术支持和参考。

【技术实现步骤摘要】

本专利技术涉及一种火星大气进入容中断估计方法，属于深空探测

技术介绍
火星定点着陆探测是获取更有科学价值发现的重要手段，为实现未来火星定点着 陆探测，在大气进入过程中必须对探测器进行制导与控制，从而保证探测器精确到达预开 伞点，而精确制导与控制的前提条件是导航系统能为探测器提供精确的状态信息。因此设 计可以精确确定探测器状态信息的导航方案及估计算法是定点着陆探测的前提条件。 以往成功着陆的探测任务中，火星大气进入段采用基于惯性测量的航位递推导航 方法。由于航位递推方法不能对初始状态偏差进行修正，以及难以消除敏感器系统偏差对 状态精度的影响，导致状态估计偏差随时间发散。而目前基于无线电测量的导航方法中，由 于无线电信号对外界环境敏感，尤其在高超声速段无线电信号因为外界等离子体干扰会存 在中断，难以精确估计探测器的状态。 针对火星大气进入段无线电导航存在测量中断现象，把火星大气进入段无线电测 量中断模拟成一个随机过程，并把多个测量模型间的转换模拟成一个马尔科夫过程。由于 系统状态方程及量测模型均呈现强非线性时变特性，传统Kalman滤波算法无法对非线性 时变系统进行滤波估计，故宜采用非线性滤波方法对探测器的状态信息进行估计。本专利技术 通过采用改进的拓展Kalman(EKF)滤波方法可以提高测量中断下探测器状态的估计精度。 用来解决进入段无线电测量中断时探测器的状态估计问题，为未来火星着陆探测中大气进 入段采用无线电导航方案设计提供技术支持和参考。
技术实现思路
本专利技术解决的技术问题是提高探测器在火星大气进入段的自主导航系统可靠性 及状态估计精度，实现进入段无线电测量中断时探测器的状态估计问题，本专利技术公开了一 种基于多模型的火星大气进入容中断估计方法，有效的抑制了无线电测量中断下探测器状 态估计发散问题，保证了系统的可靠性及状态估计精度。 本专利技术是通过下述技术方案实现的： 本专利技术公开的一种基于多模型的火星大气进入段容中断估计方法，首先，基于火 星惯性坐标系建立火星大气进入段动力学方程；其次，当探测器进入火星大气进入段后，当 无线电测量未中断时，建立无线电模型测量模型获取探测器的状态信息，所述的无线电模 型测量模型获取探测器的状态信息的方法为通过测量探测器相对信标的距离和速度信息， 通过EKF算法对探测器的状态信息进行解算获取，修正惯性单元（InertialMeasurement Unit，MU)初始误差；当无线电测量中断时通过无线电中断模型获取探测器的状态信息， 所述的无线电中断模型获取探测器的状态信息方法为将无线电测量信号视为噪声，通过修 正的EKF获取探测器的状态信息。通过无线电模型和无线电中断模型交换算法获得探测器 的最终状态估计信息，有效的抑制了无线电测量中断下探测器状态估计发散问题，保证了 系统的可靠性及状态估计精度。 本专利技术公开的具体实施步骤如 下： 步骤1 :建立火星大气进入段动力学方程。 在火星惯性系下，探测器的状态X包括位置矢量r= T，速度矢量V=[Vx，Vy，VJT。火星大气进入段探测器的状态方程i= / (X)如下所示：【主权项】1. ，其特征在于：首先，基于火星惯 性坐标系建立火星大气进入段动力学方程；其次，当探测器进入火星大气进入段后，当无 线电测量未中断时，建立无线电模型测量模型获取探测器的状态信息，所述的无线电模型 测量模型获取探测器的状态信息的方法为通过测量探测器相对信标的距离和速度信息， 通过EKF算法对探测器的状态信息进行解算获取，修正惯性单元（InedialMeasurement 化it,IMU)初始误差；当无线电测量中断时通过无线电中断模型获取探测器的状态信息， 所述的无线电中断模型获取探测器的状态信息方法为将无线电测量信号视为噪声，通过修 正的EKF获取探测器的状态信息；通过无线电模型和无线电中断模型交换算法获得探测器 的最终状态估计信息，有效的抑制了无线电测量中断下探测器状态估计发散问题，保证了 系统的可靠性及状态估计精度。2. 根据权利要求1所述的，其特征在 于；具体实现步骤如下， 步骤1 ;建立火星大气进入段动力学方程； 在火星惯性系下，探测器的状态X包括位置矢量r= T，速度矢量V= [Vy，Vy，vj T;火星大气进入段探测器的状态方程X= /(X)如下所示；其中，a表示气动加速度在惯性系下的表示，g表示重力加速度在惯性系下的表示，其 中a和g可由下式求得；其中，r表示探测器的位置在火星惯性系下的表示，<，<，<:表示风向坐标系 (Wind化ame，WF)S轴的单位矢量在火星惯性系中的表示，0表示探测器的倾侧角，是火星 大气进入段主要控制变量，本发中明倾侧角视为常值，D，L分别表示气动阻力和气动升力在 风向坐标系中的表示；其中，风向坐标系X轴定义如下：其中，上角标表示风向坐标系，Vw表示探测器相对于火星大气的速度在火星惯 性系下的表示，本专利技术中假设火星大气相对于火星表面为静止的，#表示探测器相对于火 星惯性系的速度，Q表示火星的自转角速度速度，本专利技术中忽略火星章动的因素，设Q= 4. 282829el3为常值，符号表示矢量叉乘，IIvwII表示相对速度的2范数，诗，< 轴 定义如下：其中，<位于当地水平面，<和<，<轴组成笛卡尔直角坐标系，该样可w得到风向 坐标系相对于火星惯性系的转换矩阵如下：其中，C?表示由风向坐标系转向火星惯性系转换的转换矩阵； 步骤2 ;建立火星大气进入段无线电测量模型及无线电测量中断模型，用于步骤3对探 测器位置和速度信息的修正； 探测器携带的加速度计可W测量得到探测器=轴的加速度信息，气动加速度a在风向 坐标系表示为：探测器携带的无线电信号接收机接收来自m个轨道器/地面信标的无线电信号，并从 中得到信号从轨道器/地面信标传播到探测器的时间ti及信号频率Afi的变化，计算出探 测器和m个轨道器/地面信标之间的相对距离Ri及相对速度Vi的变化，探测器和第i个轨 道器/地面信标之间的相对距离Ri和相对速度Vi表示为：式中，C为光速，ti表示第i个轨道器发射的无线电信号到达探测器的传播时间，Af表示探测器与信标之间无线电信号频率改变值，*1。。。,，表示第i个无线电信标在火星惯性 系下的位置，表示第i个无线电信标在火星惯性系下的速度表示； 则基于IMU和无线电测距、测速的导航量测模型如下：C7) 式中，a表示气动加速度如式妨所示，R=化，L，Rm]，V= ，av、rv、Vv分别为 加速度计测量噪声及无线电接收机的测量误差，针对进入段无线电测量会存在中断现象， 对测量模型进行修正如下： Yk=rkh(Xk)+u, 巧） 其中，丫k表示一个随机数，丫k= 1表示无线电测量正常，丫k=〇表示无线电测量中 I巾广 断； 步骤3结合步骤2无线电模型及中断模型对探测器状态进行解算，估计出探测器的状 态； 根据步骤1得到火星大气进入段探测器的状态方程A' =/^v)W及步骤2得到的量测模 型yk= 丫kh(Xk)+〇k,采用基于扩展卡尔曼滤波（ExtendKalmanFilter,EKF)算法，针对进 入段无线电测量存在中断的情况，把无线本文档来自技高网...

【技术保护点】
一种基于多模型的火星大气进入容中断估计方法，其特征在于：首先，基于火星惯性坐标系建立火星大气进入段动力学方程；其次，当探测器进入火星大气进入段后，当无线电测量未中断时，建立无线电模型测量模型获取探测器的状态信息，所述的无线电模型测量模型获取探测器的状态信息的方法为通过测量探测器相对信标的距离和速度信息，通过EKF算法对探测器的状态信息进行解算获取，修正惯性单元(Inertial Measurement Unit,IMU)初始误差；当无线电测量中断时通过无线电中断模型获取探测器的状态信息，所述的无线电中断模型获取探测器的状态信息方法为将无线电测量信号视为噪声，通过修正的EKF获取探测器的状态信息；通过无线电模型和无线电中断模型交换算法获得探测器的最终状态估计信息，有效的抑制了无线电测量中断下探测器状态估计发散问题，保证了系统的可靠性及状态估计精度。

【技术特征摘要】

【专利技术属性】
技术研发人员：崔平远，邓剑峰，高艾，朱圣英，徐瑞，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京;11