CN103017773A - 一种基于天体表面特征和天然卫星路标的环绕段导航方法 - Google Patents
一种基于天体表面特征和天然卫星路标的环绕段导航方法 Download PDFInfo
- Publication number
- CN103017773A CN103017773A CN2012105164526A CN201210516452A CN103017773A CN 103017773 A CN103017773 A CN 103017773A CN 2012105164526 A CN2012105164526 A CN 2012105164526A CN 201210516452 A CN201210516452 A CN 201210516452A CN 103017773 A CN103017773 A CN 103017773A
- Authority
- CN
- China
- Prior art keywords
- road sign
- navigation
- celestial body
- detector
- road
- 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
技术领域
本发明涉及一种基于天体表面特征和天然卫星路标的环绕段导航方法,属于深空探测自主导航领域。
背景技术
深空天体环绕探测是对目标天体长期、抵近和全面观测的重要手段。受到携带推进剂总量的限制,深空天体探测器经过行星际飞行抵达目标天体后,并不能直接制动和进入环绕目标天体的圆形轨道,而是运行在大椭圆轨道上。由于大椭圆轨道受天体摄动的影响较为复杂,因此探测器的轨道确定(导航)成为深空环绕探测的一项重要技术。
目前为止,国外深空大天体环绕探测器的轨道确定还主要依靠地面测控网或深空网进行。这种方法的成本和代价很大,对测控站的全球布局、测量精度等提出了很高的要求,实时性也不易保证。而自主导航则是弥补这些缺陷的一种良好的技术手段。但是深空探测的自主导航目前还只在转移段或者着陆段进行了验证。
但在方法层面上,国内外研究人员还是对深空环绕段的自主导航技术进行了大量的研究。包括依靠目标天体视半径和视线方向测量的方法,以及以天体表面特征地形为路标的方法等。但这些方法都存在各种缺陷,难以工程应用。例如,基于目标天体视半径和视线方向测量的方法依赖于大视场的光学敏感器,它只能应用在轨道高度较高的圆形环绕轨道上,而且容易受到目标天体光照条件的影响。而基于天体表面路标点的方法适用于距离目标天体很近的环绕轨道弧段,但它依赖于大量、详细的目标天体局部地形数据或影像资料。而这恰恰是深空目标抵近探测前所缺乏的。除此以外,由于目标天体相对太阳运动,再加上探测器飞行轨道的限制和目标天体天气条件的影响,可供选择的天体表面路标点会进一步减少,这大大增加了该方法实现的困难。
发明内容
本发明的技术解决问题:克服现有技术的不足,针对深空环绕探测器往往运行于大椭圆轨道的特点,提供了一种将目标天体的天然卫星和它表面的特征地形作为路标配合使用的新方法。在轨道高度较高时以天然卫星和目标天体表面大型和明显的地貌作为路标,在轨道高度较低时以天体局部地形作为路标。扩大了路标的选择范围,提高了信息量,增加了可观测弧段,提高了自主导航的适应能力和精度。
本发明所采用的技术方案为:一种基于天体表面特征和天然卫星路标的深空探测环绕段自主导航方法,探测器运行于环绕目标深空天体的大椭圆轨道,探测器上装备有IMU(包含陀螺和加速度计)、星敏感器和光学导航相机。实现步骤如下:
(1)陀螺和星敏的惯性姿态估计
利用前一个采样周期内陀螺测量的角速度对当前时刻的探测器惯性姿态进行外推;然后利用星敏获得的光轴惯性指向测量,使用卡尔曼滤波对陀螺外推惯性姿态的误差进行估计;最后用误差的估计值修正陀螺预估的惯性姿态,获得最终的惯性姿态估计;
(2)利用加速度计测量的位置、速度外推
在陀螺测量的同时,使用加速度计获得探测器非引力加速度的测量值,利用已获得的惯性姿态估计值将它转化到惯性坐标系中;然后根据轨道动力学模型,对探测器的位置和速度进行外推;
(3)路标点信息的获取
使用探测器上安装的光学导航相机按照一定拍摄序列对可能的路标点进行拍照,路标点的选择包含了天体表面的已知位置的特征地貌和天体的天然卫星;路标点根据轨道高度、光照条件事先选择,并列入观测序列,一般来说轨道较高时选择天然卫星和目标天体大型特征地貌,轨道较低时选择天体局部地形;最后,从导航图像上提取出路标点的像素坐标,传递给导航滤波器;
(4)基于路标的探测器位置、速度的估计
基于步骤(2)中外推的探测器位置、速度对路标点的图像坐标进行预报;将实际获得的路标点像素坐标与预报值进行比对,构成测量新息;然后使用扩展卡尔曼滤波对预测的探测器位置、速度进行修正,得到最终的探测器位置、速度估计值。
(5)对每一个控制周期重复(1)~(4)的步骤,完成导航解算。
所述方法同时将天体表面特征和天然卫星均作为导航路标,在轨道高度高于天然卫星轨道时以天然卫星和天体表面大型地貌为路标,在轨道低于天然卫星轨道时以天体局部地形为路标,导航滤波解算过程中路标点的数量可变。
本发明与现有技术相比的优点在于:本发明将深空天体的天然卫星也扩展为自主导航的路标点,从而增加了可供选择的路标点的种类,降低了对目标天体表面局部特征地形先验知识的需求,减少了地面选择和确定路标点的困难。而且针对深空环绕段大椭圆轨道上探测器距目标天体高度变化很大的特点,在环绕轨道的近点附近主要使用天体特征地形为路标,在环绕段的远点附近将天然卫星与天体表面明显的地貌结合使用,提高了导航方法对深空大椭圆环绕轨道的适应能力。
附图说明
图1是深空环绕段基于路标的自主导航***框图;
图2是以火星为代表的深空环绕段以天体表面特征和天然卫星作为路标的导航方法原理;
图3是深空环绕段不同时间点所选择的路标类型;
图4是深空环绕段导航位置误差变化曲线;
图5是深空环绕段导航速度误差变化曲线。
具体实施方式
探测器运行于环绕目标深空天体的大椭圆轨道,探测器上装备有IMU(包含陀螺和加速度计)、星敏感器和光学导航相机。
如图1所示,本发明具体计算过程如下:
第一步,进行陀螺+星敏的探测器姿态估计
(1)陀螺测量
设当前时刻为tk,上一次采样时刻为tk-1,那么陀螺可以获得在[tk-1,tk]时间段内的探测器角度增量Δgb,上标b表示探测器的本体坐标系(Ob-XbYbZb),该坐标系固联在探测器上,原点与探测器质心重合,三个轴平行于探测器惯量主轴。
角度增量除以采样时间间隔就可以获得该段时间内的探测器平均角速度ωb的测量值。
上标“~”表示测量值。
(2)姿态运动学外推
用四元数q=[q1,q2,q3,q4]T表示探测器相对惯性系的姿态,上标表示转置,惯性系(OI-XIYIZI)的原点在目标天体质心,三个坐标轴在惯性空间中指向特定的方向(当描述姿态运动时,将该坐标系原点从目标天体质心平移到探测器质心)。那么姿态运动学方程为
其中,
(3)星敏感器测量
在利用陀螺数据外推的同时,星敏感器也按照一定间隔进行测量。星敏感器的输出为光轴在惯性空间的指向和(上标i表示该矢量描述在惯性系下,下标star表示星敏感器),利用步骤(2)预估的姿态四元数将它们转换到探测器的本体系中,
其中A(q)表示将姿态四元数转换为姿态矩阵,有
(4)卡尔曼滤波修正
滤波器的测量方程为
其中,Vstar表示星敏感器的测量噪声,I3×3是3×3的单位矩阵,03×3是3×3的零矩阵。对于由式(10)和(11)构成的***,可以使用卡尔曼滤波估计出姿态误差和陀螺常值漂移误差。
令***状态
根据式(10)状态转移矩阵为
根据式(11)观测矩阵为
H=[I3×3 03×3] (14)
***噪声
其方差为Q。并且令
令测量量为
测量噪声为
v=vstar (18)
它的方差为R,则可以使用卡尔曼滤波进行状态估计,方法如下
xk|k-1=Φk|k-1xk-1 (19)
xk=xk|k-1+Kk(zk-Hkxk|k-1) (22)
并且,可以根据修正后的姿态四元数更新姿态矩阵
第二步,进行基于路标点的位置、速度估计
(1)加速度计测量
加速度计可以获得在[tk-1,tk]时间段内的探测器的速度增量ΔVb。速度增量除以采样时间间隔就可以获得该段时间内的探测器平均比力fb的测量值。
(2)轨道动力学外推
利用同时间段内的加速度计测量和姿态估计值,进行位置、速度的预估。用r表示探测器位置、v表示探测器速度,则惯性系(OI-XIYIZI)下探测器动力学方程为
其中,aRCS为推进***产生的加速度,gdis为引力摄动。aRCS可由加速度计的测量,并通过姿态信息计算,即
取状态量为
其中
同时可进行状态估计方差的更新
其中
(3)预估路标点位置
假定在tk时刻,根据观测序列可以在导航图像中观测到m(m≥0)个路标。以其中的第j个路标为例,它在惯性系下的位置可以根据天体或者卫星的历书计算出来。将tk时刻第j个路标的位置记为(这里省略代表时间的下标k),则它相对探测器的视线方向可用式(36)预报
写成分量形式,令ri=[xyz]T, 则有
光学导航敏感器测量坐标系(Oc-XcYcZc,其中原点在光学导航敏感器镜头中心,Xc和Yc平行于焦平面,Zc沿光轴方向)相对探测器本体系的转换关系由光学导航敏感器安装决定,记为探测器相对惯性系的姿态矩阵为(由式(26)给出),则根据坐标变换可将路标的预测视线方向转换到光学导航敏感器测量坐标系下
设相机的焦距为f,路标点成像的像点坐标为xcm,j和ycm,j,则根据成像原理,可以用式(39)和(40)预测出路标点像点的坐标为
其中,
光学导航敏感器成像,经图像处理后实际给出的是路标点的像素坐标(p,l)。忽略图像畸变,则根据式(41)和(42)可以进一步预测第j个路标的像素坐标
其中,Kx和Ky是相机的成像参数,它反映了像点位置与像素坐标之间的比例关系。
(4)通过导航相机获取路标点位置
在tk时刻,使用光学导航敏感器成像,通过图像处理技术从实际拍摄的导航图像中提取路标点的像素坐标。设当前导航图像中包含了m个路标,其中第j个路标的实际像素坐标为(pm,j,lm,j),它与真实的探测器位置之间满足成像关系
其中,vp,j和vl,j是成像噪声。
(5)扩展卡尔曼滤波
令Zj=[pm,j,lm,j]T,则式(43)和(44)可以构成测量方程
Zj=hj(X)+vj (45)
其中,
那么由当前时刻同时获得的m个路标构成的完成的滤波测量方程为
Z=h(X)+v (48)
其中,
并设v的方差为R。
如此,就可以使用扩展卡尔曼滤波进行状态估计。
首先,根据式(34)预测的状态方差阵计算滤波增益阵
且有
然后利用实际的测量对预估的状态进行修正
最后对预测的状态方差阵进行修正
随着时间的递推,重复上述步骤,就完成了基于路标的环绕段导航解算。
仿真分析。以环绕火星飞行的探测器为例对本发明提出的导航方法进行验证。设探测器轨道的近火点高度为353km,远火点高度56600km。探测器在环绕飞行过程中根据光照条件、飞行高度和目标的可见性分段选择火卫一、火卫二或者火星表面的特征地形为路标进行自主导航,如图2所示。使用的导航相机视场为2°,焦距为0.1m,像素分辨率为1024×1024。路标点像素提取精度为0.1像素(1σ),导航修正的周期为1分钟。
从近火点开始一个轨道周期内的导航路标选择如图3所示。其优先级按照可见性和光照条件,以先火卫一、然后火卫二、最后火星表面特征地形为顺序。相应的导航位置误差和速度误差的变化曲线如图4和图5所示。从图可见,全程导航位置误差小于2km,速度误差小于3m/s。
本发明未详细阐述部分属于本领域公知技术。
Claims (2)
1.一种基于天体表面特征和天然卫星路标的环绕段导航方法,其特征在于实现步骤如下:
(1)陀螺和星敏感器的惯性姿态估计
利用前一个采样周期内陀螺测量的角速度对当前时刻的探测器惯性姿态进行外推;然后利用星敏感器获得的光轴惯性指向测量,使用卡尔曼滤波对陀螺外推惯性姿态的误差进行估计;最后用误差的估计值修正陀螺预估的惯性姿态,获得最终的惯性姿态估计;
(2)利用加速度计测量的位置、速度外推
在陀螺测量的同时,使用加速度计获得探测器非引力加速度的测量值,利用已获得的惯性姿态估计值将它转化到惯性坐标系中;然后根据轨道动力学模型,对探测器的位置和速度进行外推;
(3)路标点信息的获取
使用探测器上安装的光学导航相机按照一定拍摄序列对可能的路标点进行拍照,路标点的选择包含了天体表面的已知位置的特征地貌和天体的天然卫星;路标点根据轨道高度、光照条件事先选择,并列入观测序列;最后,从导航图像上提取出路标点的像素坐标,传递给导航滤波器;
(4)基于路标的探测器位置、速度的估计
基于步骤(2)中外推的探测器位置、速度对路标点的图像坐标进行预报;将实际获得的路标点像素坐标与预报值进行比对,构成测量新息;然后使用扩展卡尔曼滤波对预测的探测器位置、速度进行修正,得到最终的探测器位置、速度估计值;
(5)对每一个控制周期重复(1)~(4)的步骤,完成导航解算。
2.根据权利要求1所述的基于天体表面特征和天然卫星路标的环绕段导航方法,其特征在于:所述方法同时将天体表面特征和天然卫星均作为导航路标,在轨道高度高于天然卫星轨道时以天然卫星和天体表面大型地貌为路标,在轨道低于天然卫星轨道时以天体局部地形为路标,导航滤波解算过程中路标点的数量可变。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210516452.6A CN103017773B (zh) | 2012-11-30 | 2012-11-30 | 一种基于天体表面特征和天然卫星路标的环绕段导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210516452.6A CN103017773B (zh) | 2012-11-30 | 2012-11-30 | 一种基于天体表面特征和天然卫星路标的环绕段导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103017773A true CN103017773A (zh) | 2013-04-03 |
CN103017773B CN103017773B (zh) | 2015-08-19 |
Family
ID=47966648
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210516452.6A Active CN103017773B (zh) | 2012-11-30 | 2012-11-30 | 一种基于天体表面特征和天然卫星路标的环绕段导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103017773B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109459042A (zh) * | 2018-12-07 | 2019-03-12 | 上海航天控制技术研究所 | 一种基于天地影像的航天器多模式自主导航*** |
CN111351480A (zh) * | 2020-03-17 | 2020-06-30 | 北京航空航天大学 | 一种基于转动的飞行器调姿路径优化方法 |
CN111637894A (zh) * | 2020-04-28 | 2020-09-08 | 北京控制工程研究所 | 一种定常系数陆标图像导航滤波方法 |
CN111897412A (zh) * | 2019-05-05 | 2020-11-06 | 清华大学 | 动作捕捉装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1851408A (zh) * | 2006-05-31 | 2006-10-25 | 哈尔滨工业大学 | 基于多天体路标的星际巡航自主导航方法 |
CN101275847A (zh) * | 2007-03-29 | 2008-10-01 | 北京控制工程研究所 | 低轨道航天器的紫外光成像式自主导航敏感器*** |
CN101435704A (zh) * | 2008-12-04 | 2009-05-20 | 哈尔滨工业大学 | 一种星敏感器高动态下的星跟踪方法 |
US20090326816A1 (en) * | 2006-05-30 | 2009-12-31 | Choon Bae Park | Attitude correction apparatus and method for inertial navigation system using camera-type solar sensor |
-
2012
- 2012-11-30 CN CN201210516452.6A patent/CN103017773B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090326816A1 (en) * | 2006-05-30 | 2009-12-31 | Choon Bae Park | Attitude correction apparatus and method for inertial navigation system using camera-type solar sensor |
CN1851408A (zh) * | 2006-05-31 | 2006-10-25 | 哈尔滨工业大学 | 基于多天体路标的星际巡航自主导航方法 |
CN101275847A (zh) * | 2007-03-29 | 2008-10-01 | 北京控制工程研究所 | 低轨道航天器的紫外光成像式自主导航敏感器*** |
CN101435704A (zh) * | 2008-12-04 | 2009-05-20 | 哈尔滨工业大学 | 一种星敏感器高动态下的星跟踪方法 |
Non-Patent Citations (1)
Title |
---|
肖松等: "星图匹配/惯性组合导航技术研究", 《光学技术》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109459042A (zh) * | 2018-12-07 | 2019-03-12 | 上海航天控制技术研究所 | 一种基于天地影像的航天器多模式自主导航*** |
CN111897412A (zh) * | 2019-05-05 | 2020-11-06 | 清华大学 | 动作捕捉装置 |
CN111897412B (zh) * | 2019-05-05 | 2022-02-11 | 清华大学 | 动作捕捉装置 |
CN111351480A (zh) * | 2020-03-17 | 2020-06-30 | 北京航空航天大学 | 一种基于转动的飞行器调姿路径优化方法 |
CN111351480B (zh) * | 2020-03-17 | 2021-10-15 | 北京航空航天大学 | 一种基于转动的飞行器调姿路径优化方法 |
CN111637894A (zh) * | 2020-04-28 | 2020-09-08 | 北京控制工程研究所 | 一种定常系数陆标图像导航滤波方法 |
CN111637894B (zh) * | 2020-04-28 | 2022-04-12 | 北京控制工程研究所 | 一种定常系数陆标图像导航滤波方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103017773B (zh) | 2015-08-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109991636A (zh) | 基于gps、imu以及双目视觉的地图构建方法及*** | |
CN103033189B (zh) | 一种深空探测巡视器惯性/视觉组合导航方法 | |
CN100587641C (zh) | 一种适用于任意运动微小型***的定姿*** | |
CN101344391B (zh) | 基于全功能太阳罗盘的月球车位姿自主确定方法 | |
CN106017463A (zh) | 一种基于定位传感装置的飞行器定位方法 | |
CN105953796A (zh) | 智能手机单目和imu融合的稳定运动跟踪方法和装置 | |
CN102175241B (zh) | 一种火星探测器巡航段自主天文导航方法 | |
CN105044668A (zh) | 一种基于多传感器装置的wifi指纹数据库构建方法 | |
CN109931955B (zh) | 基于状态相关李群滤波的捷联惯性导航***初始对准方法 | |
CN103913181A (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN103335654B (zh) | 一种行星动力下降段的自主导航方法 | |
CN103076015A (zh) | 一种基于全面最优校正的sins/cns组合导航***及其导航方法 | |
CN103884340B (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
CN110595503B (zh) | 基于李群最优估计的sins捷联惯性导航***晃动基座自对准方法 | |
CN109269511B (zh) | 未知环境下行星着陆的曲线匹配视觉导航方法 | |
CN103438890B (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
CN103542853B (zh) | 一种估计加速度计漂移的绝对导航滤波方法 | |
CN106017460B (zh) | 一种地形辅助惯导紧组合的水下潜器导航定位方法 | |
KR101179108B1 (ko) | 중첩 전방위 영상을 이용하여 객체의 3차원 좌표를 결정하기 위한 시스템 및 그 방법 | |
CN102707080B (zh) | 一种星敏感器模拟捷联惯导陀螺的方法 | |
CN102519485A (zh) | 一种引入陀螺信息的二位置捷联惯性导航***初始对准方法 | |
CN103604428A (zh) | 基于高精度水平基准的星敏感器定位方法 | |
CN103871075A (zh) | 一种大椭圆遥感卫星地球背景相对运动估计方法 | |
CN103017773A (zh) | 一种基于天体表面特征和天然卫星路标的环绕段导航方法 | |
CN106672265A (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 |