CN102116628A - 一种着陆或附着深空天体探测器的高精度导航方法 - Google Patents
一种着陆或附着深空天体探测器的高精度导航方法 Download PDFInfo
- Publication number
- CN102116628A CN102116628A CN2009102169969A CN200910216996A CN102116628A CN 102116628 A CN102116628 A CN 102116628A CN 2009102169969 A CN2009102169969 A CN 2009102169969A CN 200910216996 A CN200910216996 A CN 200910216996A CN 102116628 A CN102116628 A CN 102116628A
- Authority
- CN
- China
- Prior art keywords
- detector
- coordinate system
- overbar
- celestial body
- celestial
- 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
本发明属于深空探测器的制导、导航与控制技术领域,具体公开一种着陆或附着深空天体探测器的高精度导航方法,它包括以下步骤:(1)确定探测器本体坐标系的三维速度;(2)确定探测器本体坐标系的天体中心位置初值;(3)确定本体系的天体中心位置和方向;(4)确定探测器相对轨道坐标系的姿态角和速度;(5)确定探测器相对天体表面的高度;(6)确定探测器相对轨道坐标系的角速度。本发明的方法不受惯性导航误差随时间不断增大的影响,能够有效地提高着陆或附着探测器自主导航关键导航参数的精度,能够满足高精度着陆或附着深空天体探测器制导与控制的需要。
Description
技术领域
本发明属于深空探测器的制导、导航与控制技术领域,具体涉及一种可以应用于着陆或附着深空天体探测器的高精度导航方法。
背景技术
由于深空天体与地球之间的远距离,基于地面深空网的导航很难满足深空着陆或附着GNC***对探测器状态实时性和精度的要求,因此,自主导航就成为安全和准确地着陆或附着深空天体的一项关键技术。基于IMU的导航早在美国的Apollo、Surveyor和前苏联的Luna系列等着陆任务就已得到应用。近期的一些深空着陆器,如美国的Phoenix和MSL火星着陆器、日本的Selene-B月球着陆器等仍然采用了基于IMU的导航,因此,基于IMU的导航依然是深空天体着陆的主要自主导航方式。由于初始导航误差和IMU测量误差的累积将导致导航误差逐渐增大,因此,为了保证导航精度和提高探测器相对天体表面的测量精度,必须利用一些敏感器提供的探测器相对天体表面的测量信息对惯性导航结果进行修正。
对于深空天体着陆探测器的导航,探测器相对着陆目标天体表面的距离和速度是重要的观测量,前苏联的Lunar系列探测器、美国的Surveyor和Apollo系列探测器都采用测距仪和测速仪获取探测器相对月面的距离和速度信息。目前采用的方法是利用惯性导航位置确定天体中心的方向,将测距仪获取探测器相对天体表面的距离利用惯性姿态转化为相对天体表面的高度,结合测速仪获取的速度,用来修正或替换惯性导航的高度和三维速度信息,而无法修正惯性导航提供的位置和姿态误差,必然导致导航姿态、高度和速度误差随着时间的增大而逐渐增大,因此,无法满足高精度着陆或附着深空天体探测器制导与控制的需求。
发明内容
针对目前方法存在的不足,本发明提出一种着陆或附着深空天体探测器的高精度导航方法,该方法不受惯性导航误差随时间不断增大的影响,能够有效地提高着陆或附着探测器自主导航关键导航参数的精度,能够满足高精度着陆或附着深空天体探测器制导与控制的需要。
实现本发明目的的技术方案:一种着陆或附着深空天体探测器的高精度导航方法,它包括以下步骤:
(1)确定探测器本体坐标系的三维速度;
(2)确定探测器本体坐标系的天体中心位置初值;
(3)确定本体系的天体中心位置和方向;
(4)确定探测器相对轨道坐标系的姿态角和速度;
(5)确定探测器相对天体表面的高度;
(6)确定探测器相对轨道坐标系的角速度。
所述的步骤(1)中确定探测器本体坐标系的三维速度的具体步骤为:
所述的步骤(2)中确定探测器本体坐标系的天体中心位置初值(x′b,y′b,z′b)的具体步骤为:
采用探测器上的陀螺测量探测器姿态角速度ω,根据前一时刻t0的探测器惯性姿态四元素q=[q1 q2 q3 q4]T,确定当前时刻t的探测器本体坐标系与惯性系的姿态转换阵CbI;
其中,
设加速度计测量得到的速度增量为Δvb和地面测控提供的轨道初值为rI0和vI0;
进而确定探测器本体坐标系的天体中心位置初值rb(0)=(x′b,y′b,z′b)=CbIrI。
采用探测器上的测距仪测量测距仪第i个视线指向的距离ρi,(i=1,2,…,n),其中,n为测距仪的视线方向个数,n≥3,测距仪的安装需要保证视线指向和天体表面相交;
测距仪的指向在探测器本体坐标系的方向矢量为(abi,bbi,cbi),天体表面点在探测器本体坐标系的坐标(xb,yb,zb)=(abiρi,bbiρi,cbiρi);
取天体中心在探测器本体坐标系的坐标为(xbo,ybo,zbo),则天体的简化表达式模型写为
f(xbo,ybo,zbo,xb,yb,zb)=0(1)
根据式(1)、(xb,yb,zb)=(abiρi,bbiρi,cbiρi)有
f(xbo,ybo,zbo,abiρi,bbiρi,cbiρi)=0,(i=1,2,…,n)(2)
所述的步骤(4)中确定探测器相对轨道坐标系的姿态角和速度的具体步骤为:
取eox,eoy,eoz分别表示轨道系的三个轴的单位矢量,则利用本体坐标系的观测量构造出轨道系的三个坐标轴矢量为
则本体系相对轨道系的姿态转换矩阵Cbo为
Cbo=[ebx eby ebz](4)
利用本体坐标的探测器三维速度和姿态转换矩阵确定探测器相对轨道坐标系的三维速度矢量为即确定了轨道坐标系的速度。
根据测距仪获取的本体坐标系视线距离ρi确定探测器相对天体表面的高度h=ρicos(θi)。
所述的步骤(6)中确定探测器相对轨道坐标系的角速度的具体步骤为:
本发明的有益技术效果在于:本方明利用探测器测速仪测量的探测器三个波束方向速度和测距仪测量的三个及以上非共面视线距离确定了本体坐标系的天体中心方向和探测器本体坐标系相对轨道坐标系的姿态转换阵、姿态角和姿态角速度。利用探测器本体坐标系的速度和姿态转换阵确定了探测器相对轨道坐标系的速度。本体坐标系的天体中心方向和测距仪本体坐标系的任意一个波束指向确定探测器相对天体表面的高度。本发明是直接根据探测器本体坐标系的测量数据确定相对轨道坐标系的姿态、姿态角速度、速度以及高度,不受惯性导航误差随时间不断增大的影响,可以有效地提高着陆或附着探测器自主导航关键导航参数的精度,可以满足高精度着陆或附着深空天体探测器制导与控制的需要。
附图说明
图1为本发明所提供的一种着陆或附着深空天体探测器的高精度导航方法的流程图。
具体实施方式
下面结合附图和实施对本发明作进一步详细说明。
如图1所示,一种着陆或附着深空天体探测器的高精度导航方法,它包括以下步骤:
(1)确定探测器本体坐标系的三维速度vb
本体坐标系定义为:原点为探测器的质心,三个轴指向探测器的惯量主轴的坐标系。
(2)确定探测器本体坐标系的天体中心位置初值(x′b,y′b,z′b)
采用探测器上的陀螺测量探测器姿态角速度ω,根据前一时刻t0的探测器惯性姿态四元素q=[q1 q2 q3 q4]T,,初始惯性姿态四元素利用着陆或附着过程开始前的星敏感器测量确定,)确定当前时刻t的探测器本体坐标系与惯性系的姿态转换阵CbI;
设加速度计测量得到的速度增量为Δvb和地面测控提供的轨道初值为rI0(位置)和vI0(速度)。记确定探测器的惯性位置确定探测器的惯性速度μ为天体引力常数;进而确定探测器本体坐标系的天体中心位置初值rb(0)=(x′b,y′b,z′b)=CbIrI。
采用探测器上的测距仪测量测距仪第i个视线指向的距离ρi,(i=1,2,…,n),其中,n为测距仪的视线方向个数,n≥3,测距仪的安装需要保证视线指向和天体表面相交。
测距仪的指向在探测器本体坐标系的方向矢量为(abi,bbi,cbi)。天体表面点在探测器本体坐标系的坐标(xb,yb,zb)=(abiρi,bbiρi,cbiρi)。
取天体中心在探测器本体坐标系的坐标为(xbo,ybo,zbo),则天体的简化表达式模型写为
f(xbo,ybo,zbo,xb,yb,zb)=0(1)
根据式(1)、(xb,yb,zb)=(abiρi,bbiρi,cbiρi)有
f(xbo,ybo,zbo,abiρi,bbiρi,cbiρi)=0,(i=1,2,…,n)(2)
由上式(2)可知,要计算出天体中心在探测器本体坐标系的坐标(xbo,ybo,zbo),至少需要三个视线指向距离ρi。由于式(2)是非线性方程组,因此,只能采用非线性方程的数值解法,这里采用高斯-牛顿法求解,(xbo,ybo,zbo)的初值为步骤(2)中的探测器本体坐标系的天体中心位置初值rb(0)=(x′b,y′b,z′b)。
具体步骤为:(a)(b)δrb(n-1)=(HT(rb(n-1))H(rb(n-1)))HT(rb(n-1))(-f(rb(n-1))),(c)rb(n)=rb(n-1)+δrb(n-1),重复(a)、(b)、(c),直至一般可以取ε=1×10-5。
由于可以通过安装保证视线夹角尽可能的大,方程组的形态较好,所以一般几次迭代就收敛,而且一般取n=3就可以了,因此,计算量很少。
取eox,eoy,eoz分别表示轨道系的三个轴的单位矢量,则利用本体坐标系的观测量构造出轨道系的三个坐标轴矢量为
则本体系相对轨道系的姿态转换矩阵Cbo为
Cbo=[ebx eby ebz](4)
(5)确定探测器相对天体表面的高度h
利用本体坐标系的天体中心方向(rb0)和测距仪本体坐标系的任意一个波束指向lbi=(abi bbi,cbi)确定两者的夹角关系:
根据测距仪获取的本体坐标系视线距离ρi确定探测器相对天体表面的高度h=ρi cos(θi)。
(6)确定探测器相对轨道坐标系的角速度
本发明说明书中未作详细描述的内容属于本领域技术人员公知的现有技术,能够很容易实现。
Claims (7)
1.一种着陆或附着深空天体探测器的高精度导航方法,其特征在于:它包括以下步骤:
(1)确定探测器本体坐标系的三维速度;
(2)确定探测器本体坐标系的天体中心位置初值;
(3)确定本体系的天体中心位置和方向;
(4)确定探测器相对轨道坐标系的姿态角和速度;
(5)确定探测器相对天体表面的高度;
(6)确定探测器相对轨道坐标系的角速度。
2.根据权利要求1所述的一种着陆或附着深空天体探测器的高精度导航方法,其特征在于:所述的步骤(1)中确定探测器本体坐标系的三维速度的具体步骤为:
采用探测器上的测速仪测量三个非共面波束的速度v1,v2,v3以及测速仪三个波束安装指向lb1,lb2,lb3,确定探测器本体坐标系的三维速度
4.根据权利要求3所述的一种着陆或附着深空天体探测器的高精度导航方法,其特征在于:所述的步骤(3)中:确定本体系的天体中心位置rb和方向 的具体步骤为:
采用探测器上的测距仪测量测距仪第i个视线指向的距离ρi,(i=1,2,…,n),其中,n为测距仪的视线方向个数,n≥3,测距仪的安装需要保证视线指向和天体表面相交;
测距仪的指向在探测器本体坐标系的方向矢量为(abi,bbi,cbi),天体表面点在探测器本体坐标系的坐标(xb,yb,zb)=(abiρi,bbiρi,cbiρi);
取天体中心在探测器本体坐标系的坐标为(xbo,ybo,zbo),则天体的简化表达式模型写为
f(xbo,ybo,zbo,xb,yb,zb)=0 (1)
根据式(1)、(xb,yb,zb)=(abiρi,bbiρi,cbiρi)有
f(xbo,ybo,zbo,abiρi,bbiρi,cbiρi)=0,(i=1,2,…,n) (2)
于是,就可以确定探测器本体坐标系的天体中心位置rb=(xbo,ybo,zbo)T。确定探测器本体系的天体中心方向
5.根据权利要求4所述的一种着陆或附着深空天体探测器的高精度导航方法,其特征在于:所述的步骤(4)中确定探测器相对轨道坐标系的姿态角和速度的具体步骤为:
取eox,eoy,eoz分别表示轨道系的三个轴的单位矢量,则利用本体坐标系的观测量构造出轨道系的三个坐标轴矢量为
则本体系相对轨道系的姿态转换矩阵Cbo为
Cbo=[ebx eby ebz] (4)
利用本体坐标的探测器三维速度和姿态转换矩阵确定探测器相对轨道坐标系的三维速度矢量为 即确定了轨道坐标系的速度。
7.根据权利要求6所述的一种着陆或附着深空天体探测器的高精度导航方法,其特征在于:所述的步骤(6)中确定探测器相对轨道坐标系的角速度的具体步骤为:
利用步骤(3)确定的位置和步骤(4)确定的速度确定探测器轨道角速度:利用陀螺测量的 确定探测器相对轨道坐标系的角速度
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 200910216996 CN102116628B (zh) | 2009-12-31 | 2009-12-31 | 一种着陆或附着深空天体探测器的高精度导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 200910216996 CN102116628B (zh) | 2009-12-31 | 2009-12-31 | 一种着陆或附着深空天体探测器的高精度导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102116628A true CN102116628A (zh) | 2011-07-06 |
CN102116628B CN102116628B (zh) | 2013-01-02 |
Family
ID=44215502
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 200910216996 Active CN102116628B (zh) | 2009-12-31 | 2009-12-31 | 一种着陆或附着深空天体探测器的高精度导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102116628B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103256932A (zh) * | 2013-05-30 | 2013-08-21 | 北京控制工程研究所 | 一种替换结合外推的着陆导航方法 |
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103466100A (zh) * | 2013-08-23 | 2013-12-25 | 北京控制工程研究所 | 一种着陆器软着陆姿态控制方法 |
CN103472848A (zh) * | 2013-09-22 | 2013-12-25 | 上海无线电设备研究所 | 一种小行星探测器着陆姿态的雷达测量方法 |
CN103591948A (zh) * | 2013-10-16 | 2014-02-19 | 北京控制工程研究所 | 一种改善着陆导航精度的初值同步方法 |
CN103592632A (zh) * | 2013-10-16 | 2014-02-19 | 北京控制工程研究所 | 一种适用于月球着陆过程的测距测速波束指向确定方法 |
CN103662096A (zh) * | 2013-12-13 | 2014-03-26 | 北京控制工程研究所 | 一种自适应动力显式制导方法 |
CN103674034A (zh) * | 2013-12-26 | 2014-03-26 | 北京控制工程研究所 | 多波束测速测距修正的鲁棒导航方法 |
CN103900576A (zh) * | 2014-03-31 | 2014-07-02 | 北京控制工程研究所 | 一种深空探测自主导航的信息融合方法 |
CN105045271A (zh) * | 2015-06-30 | 2015-11-11 | 北京航天长征飞行器研究所 | 一种欠驱动条件下的空间飞行器位置机动方法 |
CN105091801A (zh) * | 2014-05-06 | 2015-11-25 | 上海新跃仪表厂 | 用于小行星探测的附着探测敏感器及附着区障碍检测方法 |
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、***及深空着陆器 |
CN111323020A (zh) * | 2020-02-25 | 2020-06-23 | 上海航天控制技术研究所 | 一种基于火星边缘及中心多矢量观测的自主定轨方法 |
CN111846288A (zh) * | 2020-07-30 | 2020-10-30 | 北京理工大学 | 不确定环境中下的小天体软着陆微分博弈控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100428099C (zh) * | 2006-05-17 | 2008-10-22 | 哈尔滨工业大学 | 深空探测器软着陆自主障碍规避控制方法 |
CN100501331C (zh) * | 2007-02-13 | 2009-06-17 | 北京空间飞行器总体设计部 | 基于x射线脉冲星的导航卫星自主导航***与方法 |
CN101462597B (zh) * | 2009-01-15 | 2010-09-08 | 哈尔滨工业大学 | 深空探测器接近轨道修正机动时刻选取方法 |
-
2009
- 2009-12-31 CN CN 200910216996 patent/CN102116628B/zh active Active
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103363991B (zh) * | 2013-04-09 | 2015-12-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103256932B (zh) * | 2013-05-30 | 2014-12-17 | 北京控制工程研究所 | 一种替换结合外推的着陆导航方法 |
CN103256932A (zh) * | 2013-05-30 | 2013-08-21 | 北京控制工程研究所 | 一种替换结合外推的着陆导航方法 |
CN103466100A (zh) * | 2013-08-23 | 2013-12-25 | 北京控制工程研究所 | 一种着陆器软着陆姿态控制方法 |
CN103472848A (zh) * | 2013-09-22 | 2013-12-25 | 上海无线电设备研究所 | 一种小行星探测器着陆姿态的雷达测量方法 |
CN103592632A (zh) * | 2013-10-16 | 2014-02-19 | 北京控制工程研究所 | 一种适用于月球着陆过程的测距测速波束指向确定方法 |
CN103591948A (zh) * | 2013-10-16 | 2014-02-19 | 北京控制工程研究所 | 一种改善着陆导航精度的初值同步方法 |
CN103591948B (zh) * | 2013-10-16 | 2014-11-19 | 北京控制工程研究所 | 一种改善着陆导航精度的初值同步方法 |
CN103592632B (zh) * | 2013-10-16 | 2015-05-27 | 北京控制工程研究所 | 一种适用于月球着陆过程的测距测速波束指向确定方法 |
CN103662096A (zh) * | 2013-12-13 | 2014-03-26 | 北京控制工程研究所 | 一种自适应动力显式制导方法 |
CN103674034A (zh) * | 2013-12-26 | 2014-03-26 | 北京控制工程研究所 | 多波束测速测距修正的鲁棒导航方法 |
CN103900576A (zh) * | 2014-03-31 | 2014-07-02 | 北京控制工程研究所 | 一种深空探测自主导航的信息融合方法 |
CN103900576B (zh) * | 2014-03-31 | 2016-08-17 | 北京控制工程研究所 | 一种深空探测自主导航的信息融合方法 |
CN105091801A (zh) * | 2014-05-06 | 2015-11-25 | 上海新跃仪表厂 | 用于小行星探测的附着探测敏感器及附着区障碍检测方法 |
CN105091801B (zh) * | 2014-05-06 | 2019-06-21 | 上海新跃仪表厂 | 用于小行星探测的附着探测敏感器及附着区障碍检测方法 |
CN105045271A (zh) * | 2015-06-30 | 2015-11-11 | 北京航天长征飞行器研究所 | 一种欠驱动条件下的空间飞行器位置机动方法 |
CN105045271B (zh) * | 2015-06-30 | 2017-07-28 | 北京航天长征飞行器研究所 | 一种欠驱动条件下的空间飞行器位置机动方法 |
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、***及深空着陆器 |
CN109000665B (zh) * | 2018-03-20 | 2020-05-19 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、***及深空着陆器 |
CN111323020A (zh) * | 2020-02-25 | 2020-06-23 | 上海航天控制技术研究所 | 一种基于火星边缘及中心多矢量观测的自主定轨方法 |
CN111846288A (zh) * | 2020-07-30 | 2020-10-30 | 北京理工大学 | 不确定环境中下的小天体软着陆微分博弈控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102116628B (zh) | 2013-01-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102116628B (zh) | 一种着陆或附着深空天体探测器的高精度导航方法 | |
US6459990B1 (en) | Self-contained positioning method and system thereof for water and land vehicles | |
Dissanayake et al. | The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications | |
CN103674034B (zh) | 多波束测速测距修正的鲁棒导航方法 | |
US9026263B2 (en) | Automotive navigation system and method to utilize internal geometry of sensor position with respect to rear wheel axis | |
CN103913181B (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN103076015B (zh) | 一种基于全面最优校正的sins/cns组合导航***及其导航方法 | |
CN104344837B (zh) | 一种基于速度观测的冗余惯导***加速度计***级标定方法 | |
CN104515527B (zh) | 一种无gps信号环境下的抗粗差组合导航方法 | |
CN103076017B (zh) | 基于可观测度分析的火星进入段自主导航方案设计方法 | |
CN201955092U (zh) | 一种基于地磁辅助的平台式惯性导航装置 | |
CN106842271B (zh) | 导航定位方法及装置 | |
CN102116634A (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
CN101788296A (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN104019828A (zh) | 高动态环境下惯性导航***杆臂效应误差在线标定方法 | |
CN102621565A (zh) | 一种机载分布式pos的传递对准方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导***以及控制方法 | |
CN102519470A (zh) | 多级嵌入式组合导航***及导航方法 | |
CN109870173A (zh) | 一种基于校验点的海底管道惯性导航***的轨迹修正方法 | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航***的目标导航测绘方法 | |
CN103438890B (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
CN103900576A (zh) | 一种深空探测自主导航的信息融合方法 | |
CN106500693A (zh) | 一种基于自适应扩展卡尔曼滤波的ahrs算法 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 |
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 |