中文核心期刊

中国科技核心期刊

中国科学引文数据库(CSCD)来源期刊

中国高校百佳科技期刊

中国宇航学会深空探测技术专业委员会会刊

高级检索

留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

小行星动能撞击自主导航与制导方法研究

黄翔宇,徐超,胡荣海,郭敏文

downloadPDF
黄翔宇, 徐超, 胡荣海, 郭敏文. 小行星动能撞击自主导航与制导方法研究[J]. 深空探测学报(中英文), 2022, 9(4): 438-446. doi: 10.15982/j.issn.2096-9287.2022.20220054
引用本文: 黄翔宇, 徐超, 胡荣海, 郭敏文. 小行星动能撞击自主导航与制导方法研究[J]. 深空探测学报(中英文), 2022, 9(4): 438-446.doi:10.15982/j.issn.2096-9287.2022.20220054
HUANG Xiangyu, XU Chao, HU Ronghai, GUO Minwen. Autonomous Navigation and Guidance for Asteroid Kinetic Impact Mission[J]. Journal of Deep Space Exploration, 2022, 9(4): 438-446. doi: 10.15982/j.issn.2096-9287.2022.20220054
Citation: HUANG Xiangyu, XU Chao, HU Ronghai, GUO Minwen. Autonomous Navigation and Guidance for Asteroid Kinetic Impact Mission[J].Journal of Deep Space Exploration, 2022, 9(4): 438-446.doi:10.15982/j.issn.2096-9287.2022.20220054

小行星动能撞击自主导航与制导方法研究

doi:10.15982/j.issn.2096-9287.2022.20220054
基金项目:民用航天预先研究资助项目(D030105)
详细信息
    作者简介:

    黄翔宇(1976– ),男,研究员,博士生导师,主要研究方向:航天器自主导航与控制。通讯地址:北京市5142邮政信箱139分箱(100094)E-mail:huangxyhit@sina.com

    徐超(1987– ),男,高级工程师,主要研究方向:航天器自主导航。本文通讯作者。通讯地址:北京市5142邮政信箱139分箱(100094)电话:(010)68111183Email:xc_1987@126.com

  • ● An autonomous GNC scheme is proposed for near-Earth Asteroid kinetic impact mission, which can realize the impact accuracy is better than 10 meter when the relative velocity is up to 10 km/s. ● The observability analysis is performed for the relative navigation based on the line of sight (LOS) of the asteroid center, which gives the unobservable direction of the navigation system. Based on the observability analysis result, the relative position and velocity in the direction perpendicular to the LOS are separated and estimated to ensure a high-precision impact. ● An iterative prediction guidance method is adopted with incompletely estimated states for a high-precision impact and the effect of the guidance correction timing is analyzed.

Autonomous Navigation and Guidance for Asteroid Kinetic Impact Mission

  • 摘要:针对近地小行星精确撞击任务需求,提出了一种小行星高精度撞击自主导航、制导与控制(Guidance Navigation & Control,GNC)方法,包括高精度的小行星中心视线提取、基于小行星中心视线测量的高精度自主相对导航及迭代预测制导。该设计利用小行星中心视线测量实现了在垂直于视线方向上撞击器相对于小行星位置和速度的精确估计,在沿视线方向上撞击器相对位置和速度存在误差的情况下利用迭代预测制导实现了高精度撞击。数值仿真表明,所提出的方案能够实现50 m级近地小行星4 m级撞击精度,满足了任务要求。
    Highlights
    ● An autonomous GNC scheme is proposed for near-Earth Asteroid kinetic impact mission, which can realize the impact accuracy is better than 10 meter when the relative velocity is up to 10 km/s. ● The observability analysis is performed for the relative navigation based on the line of sight (LOS) of the asteroid center, which gives the unobservable direction of the navigation system. Based on the observability analysis result, the relative position and velocity in the direction perpendicular to the LOS are separated and estimated to ensure a high-precision impact. ● An iterative prediction guidance method is adopted with incompletely estimated states for a high-precision impact and the effect of the guidance correction timing is analyzed.
  • 图 1不同距离下,导航相机拍摄的小行星图像

    Fig. 1Asteroid images captured by navigation camera at different distances

    图 2不同距离下,目标小行星的中心提取结果

    Fig. 2Extracted centers of target asteroid under different distances

    图 3不同距离下,目标小行星的中心提取误差

    Fig. 3Measurement errors of target center under different distances

    图 4撞击段撞击器到小行星距离

    Fig. 4Distance between impactor and asteroid during impact phasethe impact phase

    图 5视线坐标系下撞击器相对于小行星的位置估计误差

    Fig. 5Estimation error of relative position between impactor and asteroid in LOS frame

    图 6视线坐标系下撞击器相对于小行星的速度估计误差

    Fig. 6Estimation error of relative velocity between impactor and asteroid in LOS frame

    图 7J2000惯性系下撞击器相对于小行星位置估计误差

    Fig. 7Estimation error of relative position between impactor and asteroid in J2000 inertial frame

    图 8J2000惯性系下撞击器相对于小行星速度估计误差

    Fig. 8Estimation error of relative velocity between the impactor and the asteroid in J2000 inertial frame

    图 9在J2000惯性系下撞击器轨道修正速度增量

    Fig. 9Velocity increment shown in J2000 inertial frame for impactor’s orbit corrections

    图 10撞击器相对于小行星的速度方向与位置方向夹角

    Fig. 10Angle between relative position and relative velocity between impactor and asteroid

    图 11500次打靶垂直于视线方向的撞击器相对位置估计误差

    Fig. 11Relative position errors in the plane perpendicular to the LOS in 500 Monte Carlo simulation runs

    图 12500次打靶垂直于视线方向的撞击器相对速度估计误差

    Fig. 12The relative velocity errors in the plane perpendicular to the LOS in 500 Monte Carlo simulation runs

    图 13500次打靶撞击点位置误差

    Fig. 13Impact site position errors in 500 Monte Carlo simulation runs

  • [1] 李虹琳,党丽芳. 美欧合作的近地小行星防御任务进展[J]. 空间碎片研究,2021,21(2):35-39.doi:10.19963/j.cnki.2096-4099.2021.02.008

    LI H L,DANG L F. Progress of U. S.-European joint near-Earth asteroid defense mission[J]. Space Debris Research,2021,21(2):35-39.doi:10.19963/j.cnki.2096-4099.2021.02.008
    [2] MCQUAIDE M, ATCHISON J, BELLEROSE J, et al. Double Asteroid Redirection Test (DART) phase D mission design & navigation analysis[C]//2021 IAC Planetary Defense Conference. Vienna, Austria: IAC, 2021.
    [3] 刘雪奇,孙海彬,孙胜利. 近地小行星防御策略分析[J]. 深空探测学报(中英文),2017,4(6):557-563.

    LIU X Q,SUN H B,SUN S L. Analysis of defense strategies of near-Earth asteroids[J]. Journal of Deep Space Exploration,2017,4(6):557-563.
    [4] CHAVEZ A S, MYHRE N J, PRAZENICA R J. Vision-based state estimation for asteroid exploration[C]//2017 AIAA SPACE and Astronautics Forum and Exposition. Orlando, FL: AIAA, 2017.
    [5] HU R H, HUANG X Y, XU C. Visual navigation with fast landmark selection based on error analysis for asteroid descent stage[J]. Advances in Space Research, 2021, 68(9): 37653780.
    [6] KUBOTAA T,HASHIMOTOA T,SAWAI S,et al. An autonomous navigation and guidance system for MUSES-C asteroid landing[J]. Acta Astronautica,2003,52:125-131.doi:10.1016/S0094-5765(02)00147-9
    [7] TAKAO Y,MIMASU Y,TSUDA Y. Simultaneous estimation of spacecraft position and asteroid diameter during final approach of Hayabusa2 to Ryugu[J]. Astrodynamics,2020,4(2):163-175.doi:10.1007/s42064-020-0078-5
    [8] VETRISANO M,VASILE M. Autonomous navigation of a spacecraft formation in the proximity of an asteroid[J]. Advances in Space Research,2016,57(8):1783-1804.
    [9] JIA H,ZHU S Y,CUI P Y. Observability-based navigation using optical and radiometric measurements for asteroid proximity[J]. IEEE Transactions on Aerospace and Electronic Systems,2019,56(4):2677-2688.
    [10] CROUSE B. Autonomous optical navigation for lunar missions[D]. Houston, TX: Rice University, 2009.
    [11] OWEN W M. Methods of optical navigation[C]//2011 AAS Spaceflight Mechanics Conference. New Orleans, USA: AIAA, 2011.
    [12] WRIGHT C A, LIOUNIS A J, ASHMAN B W. Optical navigation algorithm performance[C]//Annual RPI Workshop on Image Based Modeling and Navigation for Space Applications.Troy, NY: AIAA, 2018.
    [13] BHASKARAN S, RIEDEL J E, SYNNOTT S P. Autonomous nucleus tracking for comet/asteroid encounters: the Stardust example[C]//1998 IEEE Aerospace Conference. Snowmass, USA, March: IEEE, 1998.
    [14] TAKAHASHI S, SCHEERES D J. Autonomous navigation and exploration of a small near-earth asteroid[C]//2020 AAS/AIAA Astrodynamics Specialist Conference. Lake Tahoe, CA, USA: AIAA, 2020.
    [15] CHEN Z. Local observability and its application to multiple measurement estimation[J]. IEEE Transactions on Industrial Electronics,1991,38(6):491-496.doi:10.1109/41.107106
    [16] LI M,MOURIKIS A I. High-precision,consistent EKF-based visual-inertial odometry[J]. The International Journal of Robotics Research,2013,32(6):690-711.doi:10.1177/0278364913481251
  • [1] 朱庆华, 王卫华, 刘付成, 郑循江, 聂钦博.“天问一号”火星探测环绕器导航制导与控制技术. 深空探测学报(中英文), 2023, 10(1): 1-8.doi:10.15982/j.issn.2096-9287.2023.20220046
    [2] 王大轶, 符方舟, 孟林智, 李文博, 李茂登, 徐超, 葛东明.深空探测器自主控制技术综述. 深空探测学报(中英文), 2019, 6(4): 317-327.doi:10.15982/j.issn.2095-7777.2019.04.002
    [3] 马辛, 宁晓琳, 刘劲, 刘刚.一种平面约束辅助测量的深空探测器自主天文导航方法. 深空探测学报(中英文), 2019, 6(3): 293-300.doi:10.15982/j.issn.2095-7777.2019.03.014
    [4] 宁晓琳, 桂明臻, 孙晓函, 刘劲, 吴伟仁.一种基于太阳震荡时间延迟量测的自主天文导航方法. 深空探测学报(中英文), 2019, 6(1): 88-95.doi:10.15982/j.issn.2095-7777.2019.01.013
    [5] 黄翔宇, 徐超, 胡荣海, 李茂登, 郭敏文, 胡锦昌.火星精确定点着陆多信息融合自主导航与控制方法研究. 深空探测学报(中英文), 2019, 6(4): 348-357.doi:10.15982/j.issn.2095-7777.2019.04.006
    [6] 王春锋.卫星编队自主相对导航与通信一体化系统探讨. 深空探测学报(中英文), 2017, 4(1): 38-42.doi:10.15982/j.issn.2095-7777.2017.01.006
    [7] 王亚敏, 刘银雪, 蒋峻, 孙煜坤, 张永合.基于引力场不对称性的三体系统轨道自主导航. 深空探测学报(中英文), 2017, 4(1): 26-30,37.doi:10.15982/j.issn.2095-7777.2017.01.004
    [8] 欧阳威, 张洪波, 郑伟.环火星自主导航系统设计及参数优化研究. 深空探测学报(中英文), 2017, 4(1): 43-50.doi:10.15982/j.issn.2095-7777.2017.01.007
    [9] 郑伟, 张璐, 王奕迪.基于星联网的深空自主导航方案设计. 深空探测学报(中英文), 2017, 4(1): 31-37.doi:10.15982/j.issn.2095-7777.2017.01.005
    [10] 姜宇, 程彬, 宝音贺西, 李恒年.潜在威胁小行星碰撞防御的计算与分析. 深空探测学报(中英文), 2017, 4(2): 190-195.doi:10.15982/j.issn.2095-7777.2017.02.014
    [11] 张韵, 刘岩, 李俊峰.小行星防御动能撞击效果评估. 深空探测学报(中英文), 2017, 4(1): 51-57.doi:10.15982/j.issn.2095-7777.2017.01.008
    [12] 汪梁, 赵方方, 陈翠桥, 徐照钱.粒子滤波在自主天文导航系统中的性能评估和应用. 深空探测学报(中英文), 2016, 3(3): 246-252.doi:10.15982/j.issn.2095-7777.2016.03.008
    [13] 徐超, 王大轶, 黄翔宇.基于陆标图像的火星精确着陆自主导航方法研究. 深空探测学报(中英文), 2016, 3(2): 150-155.doi:10.15982/j.issn.2095-7777.2016.02.009
    [14] 陈晓, 尤伟, 黄庆龙.火星探测巡航段天文自主导航方法研究. 深空探测学报(中英文), 2016, 3(3): 214-218.doi:10.15982/j.issn.2095-7777.2016.03.003
    [15] 于正湜, 崔平远.行星着陆自主导航与制导控制研究现状与趋势. 深空探测学报(中英文), 2016, 3(4): 345-355.doi:10.15982/j.issn.2095-7777.2016.04.006
    [16] 王大铁, 李骥, 黄翔宇, 张洪华.月球软着陆过程高精度自主导航避障方法. 深空探测学报(中英文), 2014, 1(1): 44-51.
    [17] 魏二虎, 杨洪洲, 张帅, 刘经南, 易慧.脉冲星非实时平差的火星探测自主导航模型. 深空探测学报(中英文), 2014, 1(4): 298-302.doi:10.15982/j.issn.2095-7777.2014.04.009
    [18] 黄翔宇, 张洪华, 王大铁, 李骥, 关软峰, 王鹏基.“嫦娥三号”探测器软着陆自主导航与制导技术. 深空探测学报(中英文), 2014, 1(1): 52-59.
    [19] 崔平远, 高艾, 于正湜.火星着陆自主导航方案研究进展. 深空探测学报(中英文), 2014, 1(1): 18-27.
    [20] 侯建文, 周杰.“火星科学实验室”巡航段导航、制导与控制. 深空探测学报(中英文), 2014, 1(2): 110-116.
  • 加载中
图(13)
计量
  • 文章访问数:247
  • HTML全文浏览量:113
  • PDF下载量:62
  • 被引次数:0
出版历程
  • 收稿日期:2022-05-21
  • 修回日期:2022-07-24
  • 网络出版日期:2022-09-14
  • 刊出日期:2022-09-30

小行星动能撞击自主导航与制导方法研究

doi:10.15982/j.issn.2096-9287.2022.20220054
    基金项目:民用航天预先研究资助项目(D030105)
    作者简介:

    黄翔宇(1976– ),男,研究员,博士生导师,主要研究方向:航天器自主导航与控制。通讯地址:北京市5142邮政信箱139分箱(100094)E-mail:huangxyhit@sina.com

    徐超(1987– ),男,高级工程师,主要研究方向:航天器自主导航。本文通讯作者。通讯地址:北京市5142邮政信箱139分箱(100094)电话:(010)68111183Email:xc_1987@126.com

  • ● An autonomous GNC scheme is proposed for near-Earth Asteroid kinetic impact mission, which can realize the impact accuracy is better than 10 meter when the relative velocity is up to 10 km/s. ● The observability analysis is performed for the relative navigation based on the line of sight (LOS) of the asteroid center, which gives the unobservable direction of the navigation system. Based on the observability analysis result, the relative position and velocity in the direction perpendicular to the LOS are separated and estimated to ensure a high-precision impact. ● An iterative prediction guidance method is adopted with incompletely estimated states for a high-precision impact and the effect of the guidance correction timing is analyzed.

摘要:针对近地小行星精确撞击任务需求,提出了一种小行星高精度撞击自主导航、制导与控制(Guidance Navigation & Control,GNC)方法,包括高精度的小行星中心视线提取、基于小行星中心视线测量的高精度自主相对导航及迭代预测制导。该设计利用小行星中心视线测量实现了在垂直于视线方向上撞击器相对于小行星位置和速度的精确估计,在沿视线方向上撞击器相对位置和速度存在误差的情况下利用迭代预测制导实现了高精度撞击。数值仿真表明,所提出的方案能够实现50 m级近地小行星4 m级撞击精度,满足了任务要求。

注释:
1) ● An autonomous GNC scheme is proposed for near-Earth Asteroid kinetic impact mission, which can realize the impact accuracy is better than 10 meter when the relative velocity is up to 10 km/s. ● The observability analysis is performed for the relative navigation based on the line of sight (LOS) of the asteroid center, which gives the unobservable direction of the navigation system. Based on the observability analysis result, the relative position and velocity in the direction perpendicular to the LOS are separated and estimated to ensure a high-precision impact. ● An iterative prediction guidance method is adopted with incompletely estimated states for a high-precision impact and the effect of the guidance correction timing is analyzed.

English Abstract

黄翔宇, 徐超, 胡荣海, 郭敏文. 小行星动能撞击自主导航与制导方法研究[J]. 深空探测学报(中英文), 2022, 9(4): 438-446. doi: 10.15982/j.issn.2096-9287.2022.20220054
引用本文: 黄翔宇, 徐超, 胡荣海, 郭敏文. 小行星动能撞击自主导航与制导方法研究[J]. 深空探测学报(中英文), 2022, 9(4): 438-446.doi:10.15982/j.issn.2096-9287.2022.20220054
HUANG Xiangyu, XU Chao, HU Ronghai, GUO Minwen. Autonomous Navigation and Guidance for Asteroid Kinetic Impact Mission[J]. Journal of Deep Space Exploration, 2022, 9(4): 438-446. doi: 10.15982/j.issn.2096-9287.2022.20220054
Citation: HUANG Xiangyu, XU Chao, HU Ronghai, GUO Minwen. Autonomous Navigation and Guidance for Asteroid Kinetic Impact Mission[J].Journal of Deep Space Exploration, 2022, 9(4): 438-446.doi:10.15982/j.issn.2096-9287.2022.20220054
    • 太阳系中存在着大量的小天体,距离地球较近的小天体可能撞击地球,从而引发巨大的灾难。自20世纪90年代以来,近地天体撞击地球的潜在威胁受到了关注,各国开始实施小行星防御活动。在近地小行星撞击防御方面,提出了核爆、动能撞击、引力拖车等多种技术方案[1]。其中动能撞击是最为成熟的技术手段。由美国实施的“双小行星重定向测试”(Double Asteroid Redirection Test,DART)任务,以撞击双小行星系统中的一颗小行星,目前正在开展小行星动能撞击在轨技术验证[2]。在“十四五”期间,基于深空探测工程基础,中国也将论证实施近地小行星动能撞击在轨处置技术验证任务。

      与以往小行星探测任务不同的是,小行星撞击任务是通过相对速度很大的撞击器直接撞击小行星以改变小行星的动量,其一般只适用于小尺寸的小行星防御[3],DART任务目标小行星直径160 m,其对撞击精度要求极高,且在撞击段可用的小行星测量手段有限,一般仅有光学相机。基于光学图像的小行星探测自主导航方法一般可分为基于小行星中心视线测量和基于小行星表面陆标图像测量的方法。Chavez等[4-5]给出了基于光学陆标图像的小行星探测自主导航方法,但该方法只适用于距离小行星较近时的导航任务;采用小行星中心视线测量的自主导航方法由于缺少距离测量信息,通常需要辅以其他测量才能实现探测器状态的完全可观。Kubotaa等[6]给出了小行星中心视线测量结合测距信息的接近段自主导航方法;Takao等[7]给出了小行星尺寸信息辅助中心视线测量的导航方法;Jia等[8-9]给出了探测器间距离测量辅助的小行星接近段自主导航方法。这些方法均针对小行星抵近探测任务,其特点是利用光学相机得到的视线测量结合其他敏感器测量以视线探测器相对小行星位置和速度的完全估计。小行星撞击任务,由于相对速度可达10 km/s,采用测距敏感器获取距离测量信息的方法并不适用,主要是受限于测距敏感器的测量范围有限,可获取测距信息的次数极少,而且由于撞击任务中小行星尺寸小,在较远距离时要想获得距离测量需要保证极高的测距指向精度,工程实现难度大。同样小行星尺寸小,在撞击段的大部分时间里小行星在图像中均为点目标,而且通常缺少小行星精确的尺寸信息,利用小行星尺寸信息辅助的方法进行相对导航对小行星撞击任务也意义不大。对于采用探测器间距离测量辅助的方法需要同时发射多个探测器才能实施,并不是一个通用的方法,本文中并不考虑该方法。对于小行星撞击任务,本文提出仅利用小行星中心视线测量进行相对导航,将撞击器相对小行星的位置和速度中不可观方向进行分离,利用其可精确估计的位置和速度分量即可保证撞击精度,基于该方案撞击器以10 km/s的相对速度实现了50 m级近地小行星10 m级的撞击精度。

    • 小行星撞击段定义为距小行星3万km ~ 0 m的任务飞行段。针对50 m级近地小行星10 m级精度撞击任务,小行星动能撞击器在撞击段的自主导航、制导与控制(Guidance Navigation & Control,GNC)系统需要具备的功能要求:高精度的小行星观测、成像和中心提取、高精度的相对导航以及制导与控制。

      考虑远距离50 m级小行星观测的需求,选择窄视场相机、星敏和惯性测量单元( Inertial Measurement Unit,IMU)作为撞击段的主要导航敏感器,其中窄视场相机需具备在3万km探测视15等星的能力,星敏提供撞击器的姿态基准,IMU在轨道机动时提供角速度和加速度测量。

      对于小行星撞击段,窄视场相机测量的小行星中心视线方向是唯一可用的相对于小行星的测量。针对高精度小行星中心视线测量的需求,设计了远距离暗弱目标图像处理和提取方法以及图像面目标高精度中心提取方法,实现了小行星中心视线优于3角秒的提取精度。针对撞击段高精度自主相对导航的需求,设计了一种基于小行星中心视线测量的不完全可观相对自主导航方法,可观性分析表明该方法可对垂直于视线方向的相对位置和速度进行精确估计,从而可满足精确撞击制导任务需求。

      在基于小行星中心视线的自主相对导航基础上给出一种迭代预测制导方法。考虑到在撞击段开始后需要尽快消除初始的速度偏差,以及为减小最后一次轨道修正所需的速度增量,在最后一次轨道修正前还应增加一次轨道修正,因此方案选择进行3次轨道修正。综合考虑轨道修正执行所需时间约束以及总的速度增量大小约束,方案设计分别在距小行星24 000 、6 000、300 km处进行轨道修正,撞击目标位置设为视线方向与小行星表面交点处,最终实现10 m级的撞击精度。

    • 图像处理在小天体动能撞击任务中具有非常重要的作用,是视觉导航的前提,其处理结果直接影响撞击器的状态估计及后续的轨道机动。然而,从首次捕获小天体的视觉图像到高速接近并对其进行撞击的整个过程当中,目标在导航相机中的像素面积、亮度大小和细节信息的丰富程度存在巨大的差异,故需要分别使用不同的图像处理技术来获取对应的导航信息,撞击器与小行星相距2 000~300 km的情况下,直径50 m的小行星在导航相机(视场角:1°,成像像元阵的大小:2 048 × 2 048)中的图像,如图1所示。

      图 1不同距离下,导航相机拍摄的小行星图像

      Figure 1.Asteroid images captured by navigation camera at different distances

      当小天体与撞击器距离较远(大于1 000 km)时,其在图像中表现为点目标,约占几个像素。此时,通过提取目标在图像中的一阶矩(即亮度中心)来粗略估计其中心的视线方向,然后通过解析函数拟合法估计其像素坐标。当撞击器不断接近小天体,小天体在图像中逐渐由点目标拓展为面目标(相对距离小于1 000 km,撞击前100 s以内)。值得注意的是,受太阳相位角(太阳–目标小行星–导航相机之间的角度)的影响,小行星在图像中的亮度分布将随着其自旋而发生周期性的变化,且相对距离越近,这种特性越明显。此时,通过计算目标在图像中的一阶矩来估计其中心将会造成较大误差,需要采用相位角修正。

      令导航相机在k时刻观测到的图像为 ${{\boldsymbol I}_k}$ 。首先,利用中值滤波器去除图像 ${{\boldsymbol I}_k}$ 中散点噪声。然后,设置亮度阈值 $ T $ 以分割 ${{\boldsymbol I}_k}$ 中的目标小行星,得到二值图像 ${{\boldsymbol B}_k}$

      $$ {B_k} = {I_k} > T $$ (1)

      则图像 ${{\boldsymbol B}_k}$ 中非零元素所构成的集合 ${{T}_k}$ 即为目标的像素区域,计算 ${{\boldsymbol T}_k}$ 在图像 $ {B_k} $ 中的一阶矩 $\boldsymbol M$ 以粗略地估计目标的中心[10]

      $$ {\boldsymbol{M}} = \left[ {\begin{array}{*{20}{c}} {{m_x}} \\ {{m_y}} \end{array}} \right] = \frac{1}{{\sum {{{\boldsymbol T}_k}} }}\left[ {\begin{array}{*{20}{c}} {\sum\nolimits_{{T_k}} {{x_i}} } \\ {\sum\nolimits_{{T_k}} {{y_i}} } \end{array}} \right] $$ (2)

      其中: $\sum {{{{T}}_k}}$ 表示计算 ${{{T}}_k}$ 中元素的个数; $ \sum\nolimits_{{T_k}} {{x_i}} $ $ \sum\nolimits_{{T_k}} {{y_i}} $ 分别表示 ${{{T}}_k}$ 中第i个元素在目标二值图像 $ {{\boldsymbol{B}}_k} $ 中的x坐标和y坐标。

      当目标在图像中为几个像素大小的点目标时,利用点扩散函数(Point Spread Function,PSF)做进一步处理,对其亮度进行建模,并通过迭代的方法计算精度更高的目标中心。PSF取二维的高斯函数[11-12]

      $$ G({\boldsymbol x}{,}{\boldsymbol {y}})=s\times \mathrm{exp}\left(-\frac{(x-{x}_{0}{)}^{2}+(y-{y}_{0}{)}^{2}}{2{\sigma }^{2}}\right)+b $$ (3)

      其中:s为亮度比例因子; $ [ {\begin{array}{*{20}{c}} {{x_0}}&{{y_0}} \end{array}} ] $ $G({\boldsymbol x}{,}{\boldsymbol {y}})$ 的峰值坐标; $ \sigma $ 为标准差;b为背景亮度(pixels)。定义 ${\boldsymbol{x}} = [ s \quad {x_0}\quad {y_0}\quad \sigma \quad b]^{\rm{T}}$ 为待求参数。

      令图像 $ {{\boldsymbol{I}}_k} $ 中坐标为 $ [ {\begin{array}{*{20}{c}} u&v \end{array}} ] $ 的点所对应的像素亮度为 $ I\left( {u,v} \right) $ ,即观测量。而通过在一个像素宽度内对式(3)积分可以估计出图像中坐标为 $ [ {\begin{array}{*{20}{c}} u&v \end{array}} ] $ 的像素点所对应的亮度值 $ \widehat{I}(u,v) $

      $$ \hat{I}(u\text{,}v)={\displaystyle {\int }_{u-0.5}^{u+0.5}{\displaystyle {\int }_{v-0.5}^{v+0.5}G(x\text{,}y)\text{d}y\text{d}x}} $$ (4)

      则观测残差(代价函数)为

      $$ e(u\text{,}v)=I(u\text{,}v)-\hat{I}(u\text{,}v) $$ (5)

      推导 $ e(u,v) $ 相对于待求参数 $ x $ 的偏导数,可以得到其雅可比矩阵,然后通过最优化方法进行迭代求解。

      为确定优化过程的初值,令 $ {x_0} = {m_x} $ $ {y_0} = {m_y} $ b $ {I_k} $ 中非目标区域的平均亮度值,sσ $ {T_k} $ 的等效半径及M处的亮度值共同确定。

      当小行星在图像中扩展为面目标且仍无法提取出清晰的轮廓时,解析函数拟合法将不再适用。同时,由于太阳相位角的影响,目标在图像中的一阶矩与其真实的质心位置存在很大的偏差,需要对一阶矩进行修正。

      根据文献[13],对于太阳相位角α以及 $ {{\boldsymbol{T}}_k} $ 的等效半径R,偏移因子γ可通过下式计算得到

      $$ \gamma =\frac{3\text{π}R\mathrm{sin}\alpha (1+\mathrm{cos}\alpha )}{16\left[(\text{π}-\alpha )\mathrm{cos}\alpha +\mathrm{sin}\alpha \right]} $$ (6)

      须指出,式(6)适用于球形天体。然而,当不规则的小行星在距离较远的时候,仍然可用于修正其亮度中心。修正后的坐标如下

      $$ \left\{ \begin{gathered} {{\bar m}_x} = {m_x} - \gamma R\cos \theta \\ {{\bar m}_y} = {m_y} - \gamma R\sin \theta \\ \end{gathered} \right. $$ (7)

      其中: $ \theta $ 为太阳光在图像平面内的投影与图像x轴之间的夹角。

    • 在日心J2000惯性系下建立小行星的动力学方程为

      $$ \left\{ \begin{gathered} {{{\boldsymbol{\dot r}}}_{\text{A}}} = {{\boldsymbol{v}}_{\text{A}}} \\ {{{\boldsymbol{\dot v}}}_{\text{A}}} = - \frac{{{\mu _{\text{s}}}}}{{r_{\text{A}}^{\text{3}}}}{{\boldsymbol{r}}_{\text{A}}} - {\mu _{\text E}}\left( {\frac{{{{\boldsymbol{r}}_{\text{E}}}}}{{r_{\text{E}}^3}} - \frac{{{{\boldsymbol{r}}_{\text{E}}} - {{\boldsymbol{r}}_{\text{A}}}}}{{{{\left\| {{{\boldsymbol{r}}_{\text{E}}} - {{\boldsymbol{r}}_{\text{A}}}} \right\|}^3}}}} \right) + {{\boldsymbol{n}}_{\text{A}}} \\ \end{gathered} \right. $$ (8)

      其中: $ {{\boldsymbol{r}}_{\text{A}}} $ $ {{\boldsymbol{v}}_{\text{A}}} $ 分别表示小行星在日心J2000惯性系下的位置和速度; $ {\mu _{\text{s}}} $ $ {\mu _{\text{E}}} $ 分别表示太阳引力常数和地球引力常数; $ {{\boldsymbol{r}}_{\text{E}}} $ 为地球在日心J2000惯性系下的位置; $ r_{\text{A}}^{} = \left\| {{{\boldsymbol{r}}_{\text{A}}}} \right\| $ $ r_{\text{E}}^{} = \left\| {{{\boldsymbol{r}}_{\text{E}}}} \right\| $ $ {{\boldsymbol{n}}_{\text{A}}} $ 表示小行星动力学模型误差项,假设为高斯白噪声。本文小行星选为近地小行星,动力学模型只考虑太阳引力和地球引力摄动项影响,不考虑其他天体摄动及太阳光压等的影响。对于小行星动能撞击段来说,撞击器相对小行星速度快,撞击段持续时间短,因此上述假设是合理的。

      在日心J2000惯性系下建立撞击器的动力学方程为

      $$ \left\{ \begin{gathered} {{{\boldsymbol{\dot r}}}_{{\text{sc}}}} = {{\boldsymbol{v}}_{{\text{sc}}}} \\ {{{\boldsymbol{\dot v}}}_{{\text{sc}}}} = - \frac{{{\mu _{\text{s}}}}}{{r_{sc}^3}}{{\boldsymbol{r}}_{sc}} - {\mu _{\text{E}}}\left( {\frac{{{{\boldsymbol{r}}_{\text{E}}}}}{{r_{\text{E}}^3}} - \frac{{{{\boldsymbol{r}}_{\text{E}}} - {{\boldsymbol{r}}_{{\text{sc}}}}}}{{{{\left\| {{{\boldsymbol{r}}_{\text{E}}} - {{\boldsymbol{r}}_{{\text{sc}}}}} \right\|}^3}}}} \right) - {\mu _{\text{A}}}\left( {\frac{{{{\boldsymbol{r}}_{\text{A}}}}}{{r_{\text{A}}^{\text{3}}}} - \frac{{{{\boldsymbol{r}}_{\text{A}}} - {{\boldsymbol{r}}_{{\text{sc}}}}}}{{{{\left\| {{{\boldsymbol{r}}_{\text{A}}} - {{\boldsymbol{r}}_{{\text{sc}}}}} \right\|}^3}}}} \right) + \\ \qquad \Delta {{\boldsymbol{v}}_i}\delta (t - {\tau _i}) + {{\boldsymbol{a}}_{{\text{SRP}}}} + {{\boldsymbol{n}}_{{\text{sc}}}} \\ \end{gathered} \right. $$ (9)

      其中: $ {{\boldsymbol{r}}_{{\text{sc}}}} $ $ {{\boldsymbol{v}}_{{\text{sc}}}} $ 分别表示撞击器在日心J2000惯性系下的位置和速度, $ r_{{\text{sc}}}^{} = \left\| {{{\boldsymbol{r}}_{{\text{sc}}}}} \right\| $ $ {{\boldsymbol{a}}_{{\text{SRP}}}} $ 表示太阳光压引起的加速度;假设撞击器飞行过程中采用速度脉冲的形式进行轨道修正,对应加速度建模为狄拉克函数形式 $ \Delta {{\boldsymbol{v}}_i}\delta (t - {\tau _i}) $ [14] $ \Delta {{\boldsymbol{v}}_i} $ 为第i次轨道修正的速度增量, $ {\tau _i} $ 为第i次轨道修正的时间; $ {{\boldsymbol{n}}_{{\text{sc}}}} $ 表示撞击器动力学模型误差项,假设为高斯白噪声。

      对于小行星动能撞击任务来说,由于撞击段时间持续短(小于1 h),撞击器近似直线飞向小行星,因此为简化星上计算过程,导航系统中撞击器相对于小行星的动力学方程可近似描述为

      $$ \left\{ \begin{gathered} {{{\boldsymbol{\dot r}}}_{{\text{scA}}}} = {{\boldsymbol{v}}_{{\text{scA}}}} \\ {{{\boldsymbol{\dot v}}}_{{\text{scA}}}} = \Delta {{\boldsymbol{v}}_i}\delta (t - {\tau _i}) \\ \end{gathered} \right. $$ (10)

      其中: $ {{\boldsymbol{r}}_{{\text{scA}}}} $ $ {{\boldsymbol{v}}_{{\text{scA}}}} $ 分别表示撞击器在小行星J2000惯性系下的位置和速度。

      在撞击器动能撞击飞行过程中利用2.1节中方法可提取小行星中心在像平面的位置 $ ({u}_{c},{v}_{c}) $ ,建立的观测模型为

      $$ \left[ {\begin{array}{*{20}{c}} {{u_c}} \\ {{v_c}} \end{array}} \right] = \frac{f}{{{z_c}}}\left[ {\begin{array}{*{20}{c}} {{x_c}} \\ {{y_c}} \end{array}} \right] $$ (11)

      其中: $ f $ 为相机焦距。

      $$ \left[\begin{array}{c}{x}_{c}\\ {y}_{c}\\ {z}_{c}\end{array}\right]={\boldsymbol C}_{\text{CI}}({\boldsymbol r}_{\text{A}}-{\boldsymbol r}_{\text{sc}})=-{\boldsymbol C}_{\text{CI}}{\boldsymbol r}_{\text{scA}} $$ (12)

      其中: $ {{\boldsymbol{C}}_{{\text{CI}}}} $ 为J2000惯性系到相机系的转换阵,其可通过星敏感器及相机安装等确定。

      将式(10)给出的相对动力学方程作为导航系统的状态方程,将式(11)给出的小行星中心视线测量作为导航系统的观测方程,采用扩展卡尔曼滤波(Extended Kalman Filter,EKF)导航滤波方法即可对撞击器状态进行估计。

    • 根据文献[15]可得到基于小行星视线矢量导航系统的可观测矩阵

      $$ {{\boldsymbol{M}}_k} = \left[ {\begin{array}{*{20}{c}} {{{\boldsymbol{H}}_1}} \\ {{{\boldsymbol{H}}_2}{{\boldsymbol{\varPhi }}_{2,1}}} \\ \vdots \\ {{{\boldsymbol{H}}_k}{{\boldsymbol{\varPhi }}_{k,1}}} \end{array}} \right] $$ (13)

      式中: $ {{\boldsymbol{H}}_k} $ ${{\boldsymbol{\varPhi }}_{k,1}}$ 分别为观测阵和误差状态转移阵。

      $$ \left\{ \begin{gathered} {{\boldsymbol{H}}_{{\text{c}}k}} = \frac{f}{{{z_{{\text{c}}k}}}}\left[ {\begin{array}{*{20}{c}} {{z_{{\text{c}}k}}}&0&{ - {x_{{\text{c}}k}}} \\ 0&{{z_{{\text{c}}k}}}&{ - {y_{{\text{c}}k}}} \end{array}} \right] \\ {{\boldsymbol{H}}_k} = \left[ {\begin{array}{*{20}{c}} { - {{\boldsymbol{H}}_{{\text{c}}k}}{{\boldsymbol{C}}_{{\text{CI}}k}}}&{{{\boldsymbol{0}}_{2 \times 3}}} \end{array}} \right] \\ {{\boldsymbol{\varPhi }}_{k,1}} = \left[ {\begin{array}{*{20}{c}} {\boldsymbol{I}}&{{\boldsymbol{I}}({t_k} - {t_1})} \\ {{{\boldsymbol{0}}_{3 \times 3}}}&{\boldsymbol{I}} \end{array}} \right] \\ \end{gathered} \right. $$ (14)

      $$ {{\boldsymbol{H}}_k}{{\boldsymbol{\varPhi }}_{k,1}} = \left[ {\begin{array}{*{20}{c}} { - {{\boldsymbol{H}}_{{\text{c}}k}}{{\boldsymbol{C}}_{{\text{CI}}k}}}&{ - {{\boldsymbol{H}}_{{\text{c}}k}}{{\boldsymbol{C}}_{{\text{CI}}k}}({t_k} - {t_1})} \end{array}} \right] $$ (15)

      ${\boldsymbol{N}} = {\left[ {\begin{array}{*{20}{c}} {{\boldsymbol{r}}_{{\text{scA1}}}^{\text{T}}}&{\boldsymbol{v}} \end{array}_{{\text{scA1}}}^{\text{T}}} \right]^{\text{T}}}$ ,则

      $$\begin{aligned}[b] {{\boldsymbol{H}}_k}{{\boldsymbol{\varPhi }}_{k,1}}{\boldsymbol{N}} = -& {{\boldsymbol{H}}_{{\text c}k}}{{\boldsymbol{\text C}}_{{\rm CI}k}}{\boldsymbol{r}}_{\rm scA1}^{} - \\ &{{\boldsymbol{H}}_{{\rm c}k}}{{\boldsymbol{C}}_{{\rm CI}k}}{\boldsymbol{v}}_{\rm scA1}^{}({t_k} - {t_1}) = \\ & -{{\boldsymbol{H}}_{{\rm c}k}}{{\boldsymbol{C}}_{{\rm CI}k}}({\boldsymbol{r}}_{\rm scA1}^{} + {\boldsymbol{v}}_{\rm scA1}^{}({t_k} - {t_1})) = \\ & - {{\boldsymbol{H}}_{{\rm c}k}}{{\boldsymbol{C}}_{{\rm CI}k}}{\boldsymbol{r}}_{{\rm scA}k}^{} = \\ &{{\boldsymbol{H}}_{{\rm c}k}}{\boldsymbol{r}}_{{\rm c}k}^{} = {{\boldsymbol{0}}_{2 \times 1}} \end{aligned} $$ (16)

      其中: ${\boldsymbol{r}}_{\text scA1}^{}$ $ {\boldsymbol{v}}_{{\text{scA1}}}^{} $ 分别为 ${t_1}$ 时刻撞击器在小行星J2000惯性系下的位置和速度。由式(16)可知 $ {{\boldsymbol{M}}_k}{\boldsymbol{N}} = {{\boldsymbol{0}}_{2k \times 1}} $ ,即 ${\boldsymbol{N}} = {\left[ {\begin{array}{*{20}{c}} {{\boldsymbol{r}}_{{\text{scA1}}}^{\text{T}}}&{{\boldsymbol{v}}_{{\text{scA1}}}^{\text{T}}} \end{array}} \right]^{\text{T}}}$ 为系统的不可观方向。

      $k = 2$

      $$ {{\boldsymbol{M}}_2} = \left[ {\begin{array}{*{20}{c}} {{{\boldsymbol{H}}_1}} \\ {{{\boldsymbol{H}}_2}{{\boldsymbol{\varPhi }}_{2,1}}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} { - {{\boldsymbol{H}}_{{\text c1}}}{{\boldsymbol{C}}_{{\text CI1}}}}&{{{\boldsymbol{0}}_{2 \times 3}}} \\ { - {{\boldsymbol{H}}_{{\text c2}}}{{\boldsymbol{C}}_{{\text CI2}}}}&{ - {{\boldsymbol{H}}_{\text c2}}{{\boldsymbol{C}}_{{\text CI2}}}({t_2} - {t_1})} \end{array}} \right] $$

      由式(14)可知 ${{\boldsymbol{H}}_{\text c1}}$ ${{\boldsymbol{H}}_{\text c2}}$ 的秩均为2,即 $\text{rank}({\boldsymbol H}_{\text c1})=\text{rank}({\boldsymbol H}_{\text c2})=2$ ,可得 $\text{rank}({\boldsymbol M}_{2})$ =4 ,则可观测矩阵 ${{\boldsymbol{M}}_2}$ 零空间的维数为2,即对于两次观测情况下导航系统存在两个不可观方向[16]。由式(16)可知 ${{\boldsymbol{N}}_1} = {\boldsymbol{N}} = {\left[ {\begin{array}{*{20}{c}} {{\boldsymbol{r}}_{{\text{scA1}}}^{\text{T}}}&{{\boldsymbol{v}}_{s{\text{cA}}1}^{\text{T}}} \end{array}} \right]^{\text{T}}}$ ${{\boldsymbol{M}}_2}$ 零空间的一组基底。令 ${{\boldsymbol{N}}_2} = {\left[ {\begin{array}{*{20}{c}} {{{\boldsymbol{0}}_{1 \times 3}}}&{{\boldsymbol{r}}_{{\text{scA2}}}^{\text{T}}} \end{array}} \right]^{\text{T}}}$ ,易知 ${{\boldsymbol{M}}_2}{{\boldsymbol{N}}_2} = {{\boldsymbol{0}}_{4 \times 1}}$ ,显然N1N2线性无关,故 ${{\boldsymbol{M}}_2}$ 零空间可由 ${\boldsymbol N}_{1},{\boldsymbol N}_{2}$ 扩张而成,即对于两次观测情况下导航系统的两个不可观方向分别为 $ {N}_{1},{N}_{2} $

      $k > 2$

      $$ {{\boldsymbol{M}}_k} = \left[ {\begin{array}{*{20}{c}} {{{\boldsymbol{H}}_1}} \\ {{{\boldsymbol{H}}_2}{{\boldsymbol{\varPhi }}_{2,1}}} \\ \vdots \\ {{{\boldsymbol{H}}_k}{{\boldsymbol{\varPhi }}_{k,1}}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} { - {{\boldsymbol{H}}_{{\text{c1}}}}{{\boldsymbol{C}}_{{\text{CI1}}}}}&{{{\boldsymbol{0}}_{2 \times 3}}} \\ { - {{\boldsymbol{H}}_{{\text{c2}}}}{{\boldsymbol{C}}_{{\text{CI2}}}}}&{ - {{\boldsymbol{H}}_{c2}}{{\boldsymbol{C}}_{{\text{CI2}}}}({t_2} - {t_1})} \\ \vdots & \vdots \\ { - {{\boldsymbol{H}}_{{\text{c}}k}}{{\boldsymbol{C}}_{{\text{CI}}k}}}&{ - {{\boldsymbol{H}}_{{\text{c}}k}}{{\boldsymbol{C}}_{{\text{CI}}k}}({t_k} - {t_1})} \end{array}} \right] $$

      由式(14)可知 ${\text{rank}}({{\boldsymbol{H}}_{{\text c}k}}{{\boldsymbol{C}}_{{\text{CIk}}}})$ =2, $ {{\boldsymbol{H}}_{{\text{c}}k}}{{\boldsymbol{C}}_{{\text{CI}}k}}{\boldsymbol{r}}_{{\text{scA}}k}^{} = {{\boldsymbol{0}}_{2 \times 1}} $ ,则有 $ {{{\boldsymbol{r}}_{{\text{scA2}}}^{}} \mathord{\left/ {\vphantom {{{\boldsymbol{r}}_{{\text{scA2}}}^{}} {\left\| {{\boldsymbol{r}}_{{\text{scA2}}}^{}} \right\|}}} \right. } {\left\| {{\boldsymbol{r}}_{{\text{scA2}}}^{}} \right\|}} \ne {{{\boldsymbol{r}}_{{\text{scA}}k}^{}} \mathord{\left/ {\vphantom {{{\boldsymbol{r}}_{{\text{scA}}k}^{}} {\left\| {{\boldsymbol{r}}_{{\text{scA}}k}^{}} \right\|}}} \right. } {\left\| {{\boldsymbol{r}}_{{\text{scA}}k}^{}} \right\|}} $ $ {{\boldsymbol{H}}_{{\text{ck}}}}{{\boldsymbol{C}}_{{\text{CI}}k}}{\boldsymbol{r}}_{{\text{scA2}}}^{} \ne {{\boldsymbol{0}}_{2 \times 1}} $ ,即 ${{\boldsymbol{M}}_k}{{\boldsymbol{N}}_2} \ne {{\boldsymbol{0}}_{2k \times 1}}$

      可见当 $k > 2$ $ {{{\boldsymbol{r}}_{{\text{scA1}}}^{}} \mathord{\left/ {\vphantom {{{\boldsymbol{r}}_{{\text{scA1}}}^{}} {\left\| {{\boldsymbol{r}}_{{\text{scA1}}}^{}} \right\|}}} \right. } {\left\| {{\boldsymbol{r}}_{{\text{scA1}}}^{}} \right\|}} \ne {{{\boldsymbol{v}}_{{\text{scA1}}}^{}} \mathord{\left/ {\vphantom {{{\boldsymbol{v}}_{{\text{scA1}}}^{}} {\left\| {{\boldsymbol{v}}_{{\text{scA1}}}^{}} \right\|}}} \right. } {\left\| {{\boldsymbol{v}}_{{\text{scA1}}}^{}} \right\|}} $ 时,系统不可观方向有且仅有 ${\boldsymbol{N}} = {\left[ {\begin{array}{*{20}{c}} {{\boldsymbol{r}}_{{\text{scA1}}}^{\text{T}}}&{{\boldsymbol{v}}_{{\text{scA1}}}^{\text{T}}} \end{array}} \right]^{\text{T}}}$ ;当 $k > 2$ $ {{{\boldsymbol{r}}_{{\text{scA1}}}^{}} \mathord{\left/ {\vphantom {{{\boldsymbol{r}}_{{\text{scA1}}}^{}} {\left\| {{\boldsymbol{r}}_{{\text{scA1}}}^{}} \right\|}}} \right. } {\left\| {{\boldsymbol{r}}_{{\text{scA1}}}^{}} \right\|}} = {{{\boldsymbol{v}}_{{\text{scA1}}}^{}} \mathord{\left/ {\vphantom {{{\boldsymbol{v}}_{{\text{scA1}}}^{}} {\left\| {{\boldsymbol{v}}_{{\text{scA1}}}^{}} \right\|}}} \right. } {\left\| {{\boldsymbol{v}}_{{\text{scA1}}}^{}} \right\|}} $ 时,系统存在两个不可观方向

      ${{{{\boldsymbol{N}}}}_1} = {\left[ {\begin{array}{*{20}{c}} {{{{\mathbf{r}}_{{\text{scA1}}}^{\text{T}}} \mathord{\left/ {\vphantom {{{\mathbf{r}}_{{\text{scA1}}}^{\text{T}}} {\left\| {{\mathbf{r}}_{{\text{scA1}}}^{}} \right\|}}} \right. } {\left\| {{\mathbf{r}}_{{\text{scA1}}}^{}} \right\|}}}&{{{\mathbf{0}}_{1 \times 3}}} \end{array}} \right]^{\text{T}}}$

      ${{{{\boldsymbol{N}}}}_2} =$ $ {\left[ {\begin{array}{*{20}{c}} {{{\mathbf{0}}_{1 \times 3}}}&{{{{\mathbf{r}}_{{\text{scA1}}}^{\text{T}}} \mathord{\left/ {\vphantom {{{\mathbf{r}}_{{\text{scA1}}}^{\text{T}}} {\left\| {{\mathbf{r}}_{{\text{scA1}}}^{}} \right\|}}} \right. } {\left\| {{\mathbf{r}}_{{\text{scA1}}}^{}} \right\|}}} \end{array}} \right]^{\text{T}}}$

      综上可知基于小行星视线矢量导航系统,当速度方向与相对小行星位置方向不一致时有且仅有一个不可观方向,即初始位置和速度不可观;当速度方向与位置方向一致时存在两个不可观方向,即小行星视线方向的位置和速度不可观。对于小行星动能撞击任务的撞击段来说,基于小行星视线矢量导航系统撞击器视线方向的位置和速度不可观。需要注意的是,对于撞击任务首先需要保证的是成功撞击到小行星预定位置,因此只要垂直于视线方向的位置和速度可观即可满足撞击任务控制需求,在撞击段自主导航过程中也只需利用小行星视线测量对垂直于视线方向的位置和速度进行导航修正。

    • t时刻由光学相机测量得到小行星中心在相平面的位置为 $ ({u}_{\text{cA}t},{v}_{\text{cA}t}) $ ,则在小行星J2000惯性系下撞击器到小行星中心的视线矢量 ${{\boldsymbol{l}}_{{\text{A}}t}}$ 可表示为

      $$ {{\boldsymbol{l}}_{{\text{At}}}} = {\boldsymbol{C}}_{{\text{CIt}}}^{\text{T}}\frac{{{{\boldsymbol{h}}_{{\text{cA}}t}}}}{{\left\| {{{\boldsymbol{h}}_{{\text{cA}}t}}} \right\|}} $$ (17)

      其中: ${{\boldsymbol{h}}_{{\text{cA}}t}} = {\left[ {\begin{array}{*{20}{c}} {{u_{{\text{cA}}t}}}&{{v_{{\text{cA}}t}}}&f \end{array}} \right]^{\text{T}}}$ ,则t时刻在小行星J2000惯性系下制导目标位置 $ {{\boldsymbol{r}}_{{\text{target}}}} $ 设为

      $$ {{\boldsymbol{r}}_{{\text{target}}}} = - R{{\boldsymbol{l}}_{{\text{A}}t}} $$ (18)

      其中: $ R $ 为小行星半径,本文中取25 m。设t时刻导航估计的撞击器在日心J2000惯性系下的位置和速度分别为 $ {{\boldsymbol{\hat r}}_{{\text{sc}}t}} $ $ {{\boldsymbol{\hat v}}_{{\text{sc}}t}} $ ,估计的小行星位置和速度分别为 $ {{\boldsymbol{\hat r}}_{{\text{A}}t}} $ $ {{\boldsymbol{\hat v}}_{At}} $ ,则预测飞行时间 ${t_{{\text{go}}}}$ 可计算为

      $$ {t_{{\text{go}}}} = \frac{{\left\| {{{{\boldsymbol{\hat r}}}_{{\text{sc}}t}} - {{{\boldsymbol{\hat r}}}_{{\text{A}}t}} - {{\boldsymbol{r}}_{{\text{target}}}}} \right\|}}{{{{({{{\boldsymbol{\hat v}}}_{{\text{sc}}t}} - {{{\boldsymbol{\hat v}}}_{{\text{A}}t}})}^{\text{T}}}{{\boldsymbol{l}}_{{\text{A}}t}}}} $$ (19)

      利用迭代制导计算t时刻轨道修正的速度增量 $\Delta {{\boldsymbol{v}}_t}$

      $$ \left\{ \begin{gathered} \Delta {{\boldsymbol{v}}_t} = \Delta {{\boldsymbol{v}}_t} + \frac{{{{{\boldsymbol{\hat r}}}_{{\text{sc}}(t + {t_{{\text{go}}}})}} - {{{\boldsymbol{\hat r}}}_{{\text{A}}(t + {t_{{\text{go}}}})}} - {{\boldsymbol{r}}_{{\text{target}}}}}}{{{t_{{\text go}}}}} \\ {{{\boldsymbol{\hat r}}}_{{\text{sc}}(t + {t_{{\text{go}}}})}} = {\boldsymbol{f}}({{{\boldsymbol{\hat r}}}_{{\text{sc}}t}},{{{\boldsymbol{\hat v}}}_{{\text{sc}}t}} + \Delta {{\boldsymbol{v}}_t},{t_{{\text{go}}}}) \\ {{{\boldsymbol{\hat r}}}_{{\text{A}}(t + {t_{{\text{go}}}})}} = {\boldsymbol{g}}({{{\boldsymbol{\hat r}}}_{{\text{A}}t}},{{{\boldsymbol{\hat v}}}_{{\text{A}}t}},{t_{{\text{go}}}}) \\ \end{gathered} \right. $$ (20)

      其中: ${\boldsymbol{f}}({{\boldsymbol{\hat r}}_{{\text{sc}}t}},{{\boldsymbol{\hat v}}_{{\text{sc}}t}} + \Delta {{\boldsymbol{v}}_t},{t_{{\text{go}}}})$ 表示以 ${{\boldsymbol{\hat r}}_{{\text{sc}}t}},{{\boldsymbol{\hat v}}_{{\text{sc}}{t} }} + \Delta {{\boldsymbol{v}}_t}$ 为状态初值,通过式(9)所示动力学方程积分 ${t_{{\text{go}}}}$ 时间得到的 $t + {t_{{\text{go}}}}$ 时刻撞击器在日心J2000惯性系下的位置 ${{\boldsymbol{\hat r}}_{{\text{sc}}(t + {t_{{\text{go}}}})}}$ ${\boldsymbol{g}}({{\boldsymbol{\hat r}}_{{\text{A}}t}},{{\boldsymbol{\hat v}}_{{\text{A}}t}},{t_{{\text{go}}}})$ 表示以 ${{\boldsymbol{\hat r}}_{{\text{A}}t}},{{\boldsymbol{\hat v}}_{{\text{A}}t}}$ 为状态初值,通过式(8)所示动力学方程积分 ${t_{{\text{go}}}}$ 时间得到的 $t + {t_{{\text{go}}}}$ 时刻小行星在日心J2000惯性系下的位置 ${{\boldsymbol{\hat r}}_{{\text{sc}}(t + {t_{{\text{go}}}})}}$

      利用式(20)通过多次迭代即可得到满足撞击精度要求的轨道修正速度增量。

      一般来说,制导控制的目标为精确的撞击位置及撞击时间,而要实现这一目标需要导航系统能够精确给出撞击器的位置估计,考虑到小行星撞击段撞击器近似沿视线方向飞向小行星,在本节的制导方法中垂直于视线方向上的位置和速度估计决定了撞击的位置控制精度,沿视线方向上的位置和速度估计则决定了撞击时间的控制精度。由可观性分析结果可知,基于视线矢量的小行星撞击段自主相对导航系统,垂直于视线方向上的位置和速度是可被精确估计的,但沿视线方向的位置和速度不可观,导航系统未对其进行修正,制导控制过程中采用的沿视线方向上的位置和速度主要依赖先验信息。对于小行星撞击任务,重点关注撞击精度,而且沿视线方向也即撞击器飞行方向可通过无线电测控等手段获取较为精确的先验信息,因此利用本文提出的基于视线矢量的自主相对导航方法及在视线方向上位置和速度存在误差情况下的迭代制导方法能够满足小行星撞击任务的需求。

    • 本文仿真初始数据如下:撞击器在小行星轨道系下的初始位置[30 000 × sin20°,0,30 000 × cos20°] km,初始速度[−10 × sin20°, 0.001,−10 × cos20°] km/s;小行星在日心J2000惯性系下的初始位置[−80 768 079.149,−137 382 451.608, 2 507 154.394] km,初始速度[24.885 9,−12.070 2,−3.779 1] km/s;鉴于沿撞击器飞行方向上地面定轨精度较高,设置初始导航误差:垂直于视线方向上位置随机误差100 km(1σ);速度随机误差各方向10 m/s(1σ);沿视线方向的位置随机误差10 km(1σ);速度随机误差各方向1m/s(1σ);导航相机视场1°;图像分辨率2 048 × 2 048;轨道修正速度增量控制方向误差0.55°(3σ),大小误差3%。

      在撞击器接近小行星的过程当中,不同距离下目标中心的部分提取结果如图2所示,目标中心提取的测量误差如图3所示。

      图 2不同距离下,目标小行星的中心提取结果

      Figure 2.Extracted centers of target asteroid under different distances

      图 3不同距离下,目标小行星的中心提取误差

      Figure 3.Measurement errors of target center under different distances

      当撞击器与小行星距离较远时(30 000 ~1 500 km), 中心测量误差较小(0.2 pixels)并周期性地变化;因为小行星的形状不规则,同时存在自旋现象,导致其在图像当中的形状产生周期性变化,结果如图2(b)与图2(c)所示。基于该方案撞击器以10 km/s的相对速度实现了50 m级近地小行星10 m级的撞击精度。也会周期性地影响中心测量结果。随着相对距离的降低(1 500~300 km),u方向的像素测量噪声有增大的趋势;因为此时小行星在图像当中逐渐扩展为面目标,中心提取结果受太阳相位角的影响越来越大。末端(300 km)的中心提取误差为[0.446,0.073] pixels。

      撞击段撞击器到小行星中心的距离变化曲线如图4所示。基于小行星视线测量的自主导航撞击器相对与小行星位置和速度估计误差在视线坐标系下的表示如图5图6所示。其中视线坐标系定义:以式(17)中的 ${{\boldsymbol{l}}_{{\text{A}}t}}$ 为视线坐标系 ${{\boldsymbol{z}}_{{\text{LOS}}}}$ 轴指向,任取不平行于 ${{\boldsymbol{l}}_{{\rm{A}}t}}$ 的方向 ${\boldsymbol{m}}$ ,本文中取 ${\boldsymbol{m}} = {\left[ {\begin{array}{*{20}{c}} 1&0&0 \end{array}} \right]^{\text{T}}}$ ,则视线坐标系 ${{\boldsymbol{y}}_{{\text{LOS}}}} = {{\boldsymbol{l}}_{{\text{A}}t}} \times {\boldsymbol{m}}$ ,根据右手准则可得视线坐标系 ${{\boldsymbol{x}}_{{\text{LOS}}}}$ 轴。

      图 4撞击段撞击器到小行星距离

      Figure 4.Distance between impactor and asteroid during impact phasethe impact phase

      图5图6可知基于小行星视线测量的自主导航方法能够准确估计垂直与视线方向的位置和速度,对于沿视线方向上的位置和速度导航过程中未作修正。撞击器相对于小行星的位置和速度估计误差在J2000惯性系下表示的对比结果如图7图8所示,由于受到视线方向位置误差的影响,在J2000惯性系下撞击器相对于小行星的三轴位置和速度估计均不准确。

      图 5视线坐标系下撞击器相对于小行星的位置估计误差

      Figure 5.Estimation error of relative position between impactor and asteroid in LOS frame

      图 6视线坐标系下撞击器相对于小行星的速度估计误差

      Figure 6.Estimation error of relative velocity between impactor and asteroid in LOS frame

      图 7J2000惯性系下撞击器相对于小行星位置估计误差

      Figure 7.Estimation error of relative position between impactor and asteroid in J2000 inertial frame

      图 8J2000惯性系下撞击器相对于小行星速度估计误差

      Figure 8.Estimation error of relative velocity between the impactor and the asteroid in J2000 inertial frame

      根据本文给出的方案,在小行星撞击段分别在距小行星24 000、6 000和300 km处进行3次轨道修正,每次轨道修正的速度增量如图9所示,3次轨道修正的速度增量分别为1.21、0.23和1.48 m/s。在撞击段飞行过程中撞击器相对于小行星的速度方向与相对位置方向夹角如图10所示。

      图 9在J2000惯性系下撞击器轨道修正速度增量

      Figure 9.Velocity increment shown in J2000 inertial frame for impactor’s orbit corrections

      图 10撞击器相对于小行星的速度方向与位置方向夹角

      Figure 10.Angle between relative position and relative velocity between impactor and asteroid

      图9图10可知:轨道修正后相对速度与相对位置方向夹角均被修正到小于 $5 \times {10^{ - 4}}$ °,且距小行星越近时撞击器相对于小行星的位置和速度方向夹角增大速率越快。因此,最终的撞击精度由最后一次轨道修正决定,但在最后一次轨道修正前,尤其是在距离小行星较近时增加轨道修正频次,可以极大减少轨道修正所需的速度增量。

      垂直于视线方向的撞击器相对位置估计误差500次打靶仿真结果如图1113所示。其中在视线坐标系下垂直于视线方向上撞击器相对位置和速度估计误差随与小行星距离变化的曲线如图11图12所示。500次打靶中实际撞击点与目标撞击点位置误差在垂直于视线平面上的散布如图13所示,可见撞击精度均优于4 m。

      图 11500次打靶垂直于视线方向的撞击器相对位置估计误差

      Figure 11.Relative position errors in the plane perpendicular to the LOS in 500 Monte Carlo simulation runs

      图 12500次打靶垂直于视线方向的撞击器相对速度估计误差

      Figure 12.The relative velocity errors in the plane perpendicular to the LOS in 500 Monte Carlo simulation runs

      图 13500次打靶撞击点位置误差

      Figure 13.Impact site position errors in 500 Monte Carlo simulation runs

    • 针对50 m级近地小行星10 m级撞击任务,提出了一种小行星撞击段高精度自主GNC方案。针对高精度小行星中心视线测量的需求,提出了点目标和面目标的中心提取方法,首先利用矩算法获取初值,然后通过函数拟合以及相位修正来进一步提高精度,实现了中心视线的测量精度优于3″。针对撞击段高精度自主相对导航的需求,设计了一种基于小行星中心视线测量的相对自主导航方法,分析了仅利用视线测量的自主导航系统可观性,实现了对垂直于视线方向的相对位置和速度的精确估计,满足了精确撞击制导的要求。针对精确撞击制导的需求,基于相对导航的状态估计给出了一种迭代预测制导方法,分析了制导修正时机对轨道修正速度增量的影响,实现了10 m级撞击精度任务要求。

参考文献 (16)

目录

    /

      返回文章
      返回
        Baidu
        map