首页 / 专利库 / 天文学 / 天体测量 / 一种着陆深空天体探测器的降维自主导航方法

一种着陆深空天体探测器的降维自主导航方法

阅读:771发布:2020-05-27

专利汇可以提供一种着陆深空天体探测器的降维自主导航方法专利检索,专利查询,专利分析的服务。并且本 发明 属于深空探测器的制导、导航与控制技术领域,具体公开一种着陆深空天体探测器的 降维 自主导航方法,它包括以下步骤:确定当前时刻探测器相对惯性 坐标系 的 姿态 以及 位置 和速度初值;确定探测器相对天体中心的距离;确定探测器相对惯性坐标系的三维速度;构建 导航系统 的状态量、 状态方程 、观测量、观测方程和测量噪声方差阵;测量噪声方差阵的无量纲化处理和能观度的确定;采用分解变换方法处理测量噪声方差阵、观测方程、观测量和 观测矩阵 ;采用UD协方差分解的 扩展卡 尔曼滤波确定探测器相对天体中心的距离和速度。本发明的方法能够保证自主导航滤波的 稳定性 和提高关键导航参数的收敛速度和估计 精度 。,下面是一种着陆深空天体探测器的降维自主导航方法专利的具体信息内容。

1.根据权利要求1所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:它包括以下步骤:
(1)利用陀螺测量的姿态速度以及加速度计测量的速度增量和轨道初值,确定当前时刻探测器相对惯性坐标系的姿态以及位置和速度初值;
(2)利用测距测速仪测量得到的视线距离确定探测器相对天体中心的距离;
(3)利用测距测速仪测量得到的速度以及测距测速仪三个测速波束安装指向确定探测器相对惯性坐标系的三维速度;
(4)构建导航系统的状态量、状态方程、观测量、观测方程和测量噪声方差阵;
(5)测量噪声方差阵的无量纲化处理和导航参数能观度的确定;
(6)采用分解变换方法处理测量噪声方差阵、观测方程、观测量和观测矩阵,使之适合采用星上可以实现的基于UD协方差分解的滤波算法
(7)根据步骤(6)确定的观测方程、观测量和观测矩阵,采用UD协方差分解的扩展卡尔曼滤波确定探测器相对天体中心的距离和速度。
2.根据权利要求1所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:所述的步骤(1)中确定惯性坐标系的探测器位置和速度的具体步骤为:
采用探测器上的陀螺测量探测器姿态角速度ω,根据前一时刻t0的探测器惯T
性姿态四元素q=[q1 q2 q3 q4],确定当前时刻t的探测器本体坐标系与惯性系的姿 态 转 换 阵 其 中,
利用加速度计测量速度增量Δvb和轨道初值,轨道初值包括轨道位置初值rI0、轨道速度初值vI0。确定惯性坐标系的速度增量为 确定探测器的惯性坐标系位置确定探测器的惯性速度 μ为天
体引常数。
3.根据权利要求2所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:所述的步骤(2)中确定探测器相对天体中心的距离的具体步骤为:
利用惯性坐标系的探测器位置,确定探测器相对天体中心方向 根据步骤(1)确定的姿态转换阵CbI,确定探测器相对天体中心方向在本体系的指向为rb0=CbIrI0;设测距测速仪的一个测距波束在本体坐标系的指向为lb0,确定探测器相对天体中心的方向和测距波束的夹角关系: 由测距测速仪测量得到的视线距离ρ,确定探测器相对天体表面的高度h=ρcos(θ),确定探测器相对天体中心的距离为rm=h+R。
4.根据权利要求3所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:所述的步骤(3)中确定探测器相对惯性坐标系的三维速度的具体步骤为:
采用探测器上的测速仪测量三个非共面波束的速度v1,v2,v3以及测速仪三个波束安装指向lb1,lb2,lb3,确定探测器本体坐标系的三维速度 根据速度vb以及步骤(1)确定的姿态转换阵CbI,确定探测器相对惯性坐标系的三维速度vI=CbIvb。
5.根据权利要求4所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:所述的步骤(4)中构建导航系统的状态量、状态方程、观测量、观测方程和测量噪声方差阵的具体步骤为:
T
选取探测器相对天体中心的径向距离r和惯性坐标系的速度v作为状态量X=[r v],建立状态方程为
将步骤(2)中得到的探测器相对天体中心的距离rm和步骤(3)中得到的惯性坐标系的探测器三维速度vI作为观测量 建立观测方程为 测量噪声方差
阵为 于是,确定导航观测矩阵
6.根据权利要求5所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:所述的步骤(5)中测量噪声方差阵的无量纲化处理和导航参数能观度的确定的具体步骤为
单位距离L定义为天体参考半径,单位速度V定义为以参考半径为半长轴的参考圆轨道上的探测器速度 只需要对测量噪声方差阵R进行无量纲化处理,得到无量纲化的测量噪声方差阵
定义导航系统能观度矩阵 判断能观度矩阵的条件数Cond(G)是否接近1,如果能观度矩阵的条件数是否接近1,则执行步骤(6),否则执行步骤(4)。
能观度矩阵的条件数接近于1表明导航参数的能观度高。这里的导航参数包括高度和速度信息。
7.根据权利要求6所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:所述的步骤(6)中解变换方法处理测量噪声方差阵、观测方程、观测量和观测矩阵的具体步骤为:
T
测量噪声方差阵R是对称正定矩阵,对其进行UD分解,可以得到R=BDB,R′=D对角矩阵。
利用变换 确定测量噪声不相关的观测方程z′和观测量z′m及观测矩阵
H′,
8.根据权利要求7所述的一种着陆深空天体探测器的降维自主导航方法,其特征在于:所述的步骤(7)中根据上述步骤(6)确定的观测方程z′、观测量z′m、噪声方差阵R′和观测矩阵H′,采用UD协方差分解的扩展卡尔曼滤波确定探测器相对天体中心的距离和速度 的具体方法为:。
式中,K为UD协方差分解的扩展卡尔曼滤波增益, 为预估的导航参数。
利用修正后的导航参数修正步骤(1)中得到的惯性坐标系的探测器位置
利用修正后的导航参数修正步骤(1)中得到的惯性坐标系的探测器速度

说明书全文

一种着陆深空天体探测器的降维自主导航方法

技术领域

[0001] 本发明属于深空探测器的制导、导航与控制技术领域,具体涉及一种着陆深空天体探测器的降维自主导航方法。

背景技术

[0002] 由于深空天体与地球之间的远距离,基于地面深空网的导航很难满足深空着陆GNC系统对探测器状态实时性和精度的要求,因此,自主导航就成为安全和准确地着陆深空天体探测器的一项关键技术。深空着陆探测器自主导航一般采用的方法是:测距仪获取的高度和测速仪获取的本体系速度作为观测量,利用扩展卡尔曼滤波修正惯性导航的位置和速度误差。对于这种导航方法,尽管所有轨道参数都是能观的,但是由于一些轨道参数(除了径向的两维位置)的能观度较低,在导航模型误差和测量噪声特性不确定的影响下,这些能观度较低的轨道参数不但不收敛,还可能发散,影响自主导航算法稳定性和关键导航参数的估计精度。

发明内容

[0003] 本发明的目的在于提供一种着陆深空天体探测器的降维自主导航方法,该方法能够保证自主导航滤波的稳定性和提高关键导航参数的收敛速度和估计精度。
[0004] 实现本发明的技术方案:一种着陆深空天体探测器的降维自主导航方法,它包括以下步骤:
[0005] (1)利用陀螺测量的姿态速度以及加速度计测量的速度增量和轨道初值,确定当前时刻探测器相对惯性坐标系的姿态以及位置和速度初值;
[0006] (2)利用测距测速仪测量得到的视线距离确定探测器相对天体中心的距离;
[0007] (3)利用测距测速仪测量得到的速度以及测距测速仪三个测速波束安装指向确定探测器相对惯性坐标系的三维速度;
[0008] (4)构建导航系统的状态量、状态方程、观测量、观测方程和测量噪声方差阵;
[0009] (5)测量噪声方差阵的无量纲化处理和导航参数能观度的确定;
[0010] (6)采用分解变换方法处理测量噪声方差阵、观测方程、观测量和观测矩阵,使之适合采用星上可以实现的基于UD协方差分解的滤波算法;
[0011] (7)根据步骤(6)确定的观测方程、观测量和观测矩阵,采用UD协方差分解的扩展卡尔曼滤波确定探测器相对天体中心的距离和速度。
[0012] 所述的步骤(1)中确定当前时刻探测器相对惯性坐标系的姿态以及位置和速度初值的具体步骤为:
[0013] 采用探测器上的陀螺测量探测器姿态角速度ω,根据前一时刻t0的探测器T惯性姿态四元素q=[q1 q2 q3 q4](初始惯性姿态四元素利用着陆过程开始前的星敏感器测量数据确定),确定当前时刻t的探测器本体坐标系与惯性系的姿态转换阵其中,
[0014]
[0015] 利用加速度计测量速度增量Δvb和轨道初值,轨道初值包括轨道位置初值rI0、轨道速度初值vI0。可以确定惯性坐标系的速度增量为 确定探测器的惯性坐标系位置 确定探测器的惯性速度
[0016] μ为天体引常数。
[0017] 所述的步骤(2)中确定探测器相对天体中心的距离的具体步骤为:
[0018] 利用惯性坐标系的探测器位置,确定探测器相对天体中心方向 根据步骤(1)确定的姿态转换阵CbI,确定探测器相对天体中心方向在本体系的指向为rb0=CbIrI0;设测距测速仪的一个测距波束在本体坐标系的指向为lb0,确定探测器相对天体中心的方向和测距波束的夹角关系:
[0019] 由测距测速仪测量得到的视线距离ρ,确定探测器相对天体表面的高度h=ρcos(θ),确定探测器相对天体中心的距离为rm=h+R。
[0020] 所述的步骤(3)中确定探测器相对惯性坐标系的三维速度的具体步骤为:
[0021] 采用探测器上的测速仪测量三个非共面波束的速度v1,v2,v3以及测速仪三个波束安装指向lb1,lb2,lb3,确定探测器本体坐标系的三维速度 根据速度vb以及步骤(1)确定的姿态转换阵CbI,确定探测器相对惯性坐标系的三维速度vI=CbIvb。
[0022] 所述的步骤(4)中构建导航系统的状态量、状态方程、观测量、观测方程和测量噪声方差阵的具体步骤为:
[0023] 选取探测器相对天体中心的径向距离r和惯性坐标系的速度v作为状态量X=[r Tv],建立状态方程为
[0024] 将步骤(2)中得到的探测器相对天体中心的距离rm和步骤(3)中得到的惯性坐标系的探测器三维速度vI作为观测量 建立观测方程为 测量噪声方差阵为
[0025] 所述的步骤(5)中测量噪声方差阵的无量纲化处理和导航参数能观度的确定的具体步骤为
[0026] 单位距离L定义为天体参考半径,单位速度V定义为以参考半径为半长轴的参考圆轨道上的探测器速度 只需要对测量噪声方差阵R进行无量纲化处理,得到无量纲化的测量噪声方差阵
[0027] 定义导航系统能观度矩阵 判断能观度矩阵的条件数Cond(G)是否接近1,如果能观度矩阵的条件数是否接近1,则执行步骤(6),否则执行步骤(4)。
[0028] 能观度矩阵的条件数接近于1表明导航参数的能观度高。这里的导航参数包括高度和速度信息。
[0029] 所述的步骤(6)中解变换方法处理测量噪声方差阵、观测方程、观测量和观测矩阵的具体步骤为:
[0030] 测量噪声方差阵R是对称正定矩阵,对其进行UD分解,可以得到R=BDBT,R′=D对角矩阵。
[0031] 利用变换 确定测量噪声不相关的观测方程z′和观测量z′m及观测矩阵H′,
[0032] 所述的步骤(7)中根据上述步骤(6)确定的观测方程z′、观测量z′m、噪声方差阵R′和观测矩阵H′,采用UD协方差分解的扩展卡尔曼滤波确定探测器相对天体中心的距离 和速度 的具体方法为:。
[0033]
[0034] 式中,K为UD协方差分解的扩展卡尔曼滤波增益, 为预估的导航参数。
[0035] 利用修正后的导航参数修正步骤(1)中得到的惯性坐标系的探测器位置[0036] 利用修正后的导航参数修正步骤(1)中得到的惯性坐标系的探测器速度[0037] 本发明的有益技术效果:引入无量纲化处理和能观度矩阵条件数判断导航参数的能观度,通过选取探测器相对天体中心的距离和惯性系的速度作为观测量,选取关键的导航参数高度和速度作为状态量,保证了构建的降维导航方法的稳定性、收敛速度和精度。针对距离和速度测量存在相关噪声的情况,采用分解变换方法处理测量噪声方差阵、观测方程、观测量和观测矩阵,使之适合采用星上可以实现的基于UD协方差分解的滤波方法。采用降维自主导航滤波方法可以提高导航的稳定性和关键导航参数的收敛速度和估计精度,非常适合于深空着陆导航任务的应用。附图说明
[0038] 图1为本发明所提供的一种着陆深空天体的降维自主导航方法的流程图

具体实施方式

[0039] 下面结合附图和实施例对本发明作进一步详细说明。
[0040] 一种着陆深空天体探测器的降维自主导航方法,它包括以下步骤:
[0041] (1)利用陀螺测量的姿态角速度ω以及加速度计测量的速度增量Δvb和轨道初值,确定当前时刻探测器相对惯性坐标系的姿态q以及位置rI和速度vI初值[0042] 采用探测器上的陀螺测量探测器姿态角速度ω,根据前一时刻t0的探测T器惯性姿态四元素q=[q1 q2 q3 q4],初始惯性姿态四元素利用着陆过程开始前的星敏感器测量确定,确定当前时刻t的探测器本体坐标系与惯性系的姿态转换阵其中,
[0043]
[0044] 利用加速度计测量速度增量Δvb和轨道初值,轨道初值包括轨道位置初值rI0、轨道速度初值vI0。可以确定惯性坐标系的速度增量为 确定惯性坐标系的探测器位置 确定惯性坐标系的探测器速度μ为天体引力常数。
[0045] (2)利用测距测速仪测量得到的视线距离ρ确定探测器相对天体中心的距离rm[0046] 利用惯性坐标系的探测器位置,确定探测器相对天体中心方向 根据步骤(1)确定的姿态转换阵CbI,确定探测器相对天体中心方向在本体系的指向为rb0=CbIrI0;设测距测速仪的一个测距波束在本体坐标系的指向为lb0,确定探测器相对天体中心的方向和测距波束的夹角关系: 由测距测速仪测量得到的视线距离ρ,确定探测器相对天体表面的高度h=ρcos(θ),确定探测器相对天体中心的距离为rm=h+R,其中R为当地天体表面的参考半径。
[0047] (3)利用测距测速仪测量得到的速度以及测距测速仪三个测速波束安装指向确定探测器相对惯性坐标系的三维速度
[0048] 采用探测器上的测速仪测量三个非共面波束的速度v1,v2,v3以及测速仪三个波束安装指向lb1,lb2,lb3,确定探测器本体坐标系的三维速度 根据速度vb以及步骤(1)确定的姿态转换阵CbI,确定探测器相对惯性坐标系的三维速度vI=VbIvb。
[0049] (4)构建导航的状态量、状态方程、观测量、观测方程和测量噪声方差阵[0050] 选取探测器相对天体中心的径向距离r和惯性坐标系的速度v作为状态量X=[r Tv],建立状态方程为 其中,μ为天体引力常数。
[0051] 将步骤(2)中得到的探测器相对天体中心的距离rm和步骤(3)中得到的惯性坐标系的探测器三维速度vI作为观测量 建立观测方程为 其中,nr为径向距离测量噪声,nv为速度测量噪声。测量噪声方差阵为 其中,Rr、Rv、Rrv分别为径向距离测量噪声方差、速度测量噪声方差阵和距离速度测量相关噪声方差阵,设[0052]
[0053] 于是,可以确定导航观测矩阵 显然,观测矩阵H的秩为4,
[0054] 因此,导航系统状态量全部可观。
[0055] (5)测量噪声方差阵的无量纲化处理和能观度的确定
[0056] 单位距离L定义为天体参考半径,对于月球L=1738000m,单位速度V定义为以参9 3
考半径为半长轴的参考圆轨道上的探测器速度 对于月球,μ=4902.75×10m/
2
s,V=1680m/s。只需要对测量噪声方差阵R进行无量纲化处理,得到无量纲化的测量噪声方差阵 计算可得
[0057]
[0058] 定义能观度矩阵 确定能观度矩阵的条件数Cond(G)=G=1.035。
[0059] 判断能观度矩阵的条件数是否接近1,能观度矩阵的条件数在1±ε范围内说明其接近1,一般可取ε=0.2。如果能观度矩阵的条件数是否接近1,则执行步骤(6),否则执行步骤(4)。
[0060] 能观度矩阵的条件数接近于1表明导航信息的可观度高。导航信息包括高度和速度信息。
[0061] (6)采用分解变换方法处理测量噪声方差阵、观测方程、观测量和观测矩阵,使之适合采用星上可以实现的基于UD协方差分解的滤波方法。
[0062] 考虑到测量噪声方差阵R是对称正定矩阵,对其进行UD分解,可以得到R=BDBT,R′=D对角矩阵。计算得到
[0063] 为对角矩阵。
[0064] 于是利用变换 确定测量噪声不相关的观测方程z′和观测量z′m及观测矩阵H′。
[0065] (7)根据上述步骤(6)确定的观测方程z′、观测量z′m噪声方差阵R′和观测矩阵H′,采用UD协方差分解的扩展卡尔曼滤波确定探测器相对天体中心的距离 和速度
[0066]
[0067] 式中,K为UD协方差分解的扩展卡尔曼滤波增益, 为预估的导航参数。
[0068] 利用修正后的导航参数修正步骤(1)中得到的惯性坐标系的探测器位置[0069] 利用修正后的导航参数修正步骤(1)中得到的惯性坐标系的探测器速度[0070] 本发明说明书中未作详细描述的内容属于本领域专业人员公知的现有技术
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈