基于联邦卡尔曼滤波的月球车联合定位方法

魏二虎, 汤深权, 刘建栋, 董翠军

魏二虎, 汤深权, 刘建栋, 董翠军. 基于联邦卡尔曼滤波的月球车联合定位方法[J]. 武汉大学学报 ( 信息科学版), 2017, 42(10): 1431-1437. DOI: 10.13203/j.whugis20160137
引用本文: 魏二虎, 汤深权, 刘建栋, 董翠军. 基于联邦卡尔曼滤波的月球车联合定位方法[J]. 武汉大学学报 ( 信息科学版), 2017, 42(10): 1431-1437. DOI: 10.13203/j.whugis20160137
WEI Erhu, TANG Shenquan, LIU Jiandong, DONG Cuijun. A Method for Joint Positioning of Lunar Roverbased on Federated Kalman Filter[J]. Geomatics and Information Science of Wuhan University, 2017, 42(10): 1431-1437. DOI: 10.13203/j.whugis20160137
Citation: WEI Erhu, TANG Shenquan, LIU Jiandong, DONG Cuijun. A Method for Joint Positioning of Lunar Roverbased on Federated Kalman Filter[J]. Geomatics and Information Science of Wuhan University, 2017, 42(10): 1431-1437. DOI: 10.13203/j.whugis20160137

基于联邦卡尔曼滤波的月球车联合定位方法

基金项目: 

国家自然科学基金 41374012

详细信息
    作者简介:

    魏二虎, 博士, 教授, 主要从事空间大地测量和地球动力学研究.ehwei@sgg.whu.edu.cn

    通讯作者:

    汤深权, 硕士生.tangshenquan@whu.edu.cn

  • 中图分类号: P228

A Method for Joint Positioning of Lunar Roverbased on Federated Kalman Filter

Funds: 

The National Natural Science Foundation of China 41374012

More Information
  • 摘要: 针对月球车定位,设计和推导了一种基于甚长基线干涉测量(very long baseline interferometry,VLBI)和天文导航系统(celestial navigation system,CNS)相结合的月球车联合定位方法,并采用联邦卡尔曼滤波来实现位置信息的最优估计以增强系统的可靠性和容错能力。最后,通过嫦娥-3号(CE-3)实测数据的解算证明了该方法较使用最小二乘法进行联合解算和单独采用VLBI方法定位,可以获得更高的月球车定位精度。同时,也有效地保障了月球车定位的可靠性和稳定性。
    Abstract: A co-localization method for lunar rover positioning based on very long baseline interferometry (VLBI) and celestial navigation systems (CNS) is presented in the paper. A federated kalman filter was utilized to implement optimal estimation of position information in order to enhance reliability and fault tolerance ability of the system. Experimentalresults calculated with measurement data from the Chang'E-3(CE-3) mission demonstrate that this method improves the positioning accuracy of the lunar rover comparing with VLBI alone or joint calculation with Least Squares method. Furthermore, this method also guarantees the reliability and stability of lunar rover positioning.
  • 图  1   VLBI定位示意图

    Figure  1.   Schematic of VLBI Positioning

    图  2   联合解算和VLBI单独解算的对比

    Figure  2.   Comparison of Joint Solution and Single Solution of VLBI

    图  3   经纬度方向误差对比

    Figure  3.   Comparison of Error in Longitude Direction & Latitudinal Direction

    表  1   基线残差平均值和闭合值/m

    Table  1   The Mean Value and the Closure Value of Baseline Residual/m

    残差 UR-KM-TM UR-KM-BJ UR-BJ-TM TM-BJ-KM
    单一残差平均值 -2.56 0.31 0.67 -2.61
    单一残差闭合差 3.44 0.16 -0.15 -3.42
    联合残差平均值 -2.51 0.32 0.66 -2.57
    联合残差闭合差 3.40 0.16 -0.14 -3.37
    下载: 导出CSV
  • [1] 郑鑫, 刘庆会, 吴亚军, 等.基于同波束VLBI差分相时延的"玉兔"月球车动作监视分析[J].中国科学:物理学力学天文学, 2014, 44:872-877 http://www.cnki.com.cn/Article/CJFDTOTAL-JGXK201408013.htm

    Zheng Xin, Liu Qinghui, Wu Yajun, et al. Motion Monitoring and Analysis of Chang'E-3 Rover Based on Same-beam VLBI Differential Phase Delay[J]. Scientia Sinica Physics, Mechanics & Astronomy, 2014, 44:872-877 http://www.cnki.com.cn/Article/CJFDTOTAL-JGXK201408013.htm

    [2] 吴伟仁, 周建亮, 王保丰, 等.嫦娥三号"玉兔号"巡视器遥操作中的关键技术[J].中国科学:信息科学, 2014, 44(4):425-427 http://www.cnki.com.cn/Article/CJFDTOTAL-PZKX201404001.htm

    Wu Weiren, Zhou Jianliang, Wang Baofeng, et al. Key Technologies in the Teleoperation of Chang'E-3 "Jade Rabbit" Rover[J]. Science China:Information Sciences, 2014, 44(4):425-427 http://www.cnki.com.cn/Article/CJFDTOTAL-PZKX201404001.htm

    [3] 昌胜骐, 黄勇, 刘庆会, 等.利用搜索法对嫦娥三号着陆器和巡视器定位[J].宇航学报, 2015, 36(6):624-625 http://www.cnki.com.cn/Article/CJFDTOTAL-YHXB201506002.htm

    Chang Shengqi, Huang Yong, Liu Qinghui, et al. Positioning of Chang'E-3 Lander and Rover Based on Search Method[J]. Journal of Astronautics, 2015, 36(6):624-625 http://www.cnki.com.cn/Article/CJFDTOTAL-YHXB201506002.htm

    [4] 宁晓琳, 房建成.一种基于天体观测的月球车位置姿态确定方法[J].北京航空航天大学学报, 2006, 32(7):756-758 http://www.cnki.com.cn/Article/CJFDTOTAL-BJHK200607001.htm

    Ning Xiaolin, Fang Jiancheng. Position and Pose Estimation by Celestial Observation for Lunar Rovers[J]. Journal of Beijing University of Aeronautics and Astronautics, 2006, 32(7):756-758 http://www.cnki.com.cn/Article/CJFDTOTAL-BJHK200607001.htm

    [5] 裴福俊, 居鹤华, 崔平远.基于天文与速度联合观测的月球车自主导航方法[J].宇航学报, 2009, 30(2):486-491 http://www.cnki.com.cn/Article/CJFDTOTAL-YHXB200902020.htm

    Pei Fujun, Ju Hehua, Cui Pingyuan. Autonomous Navigation Method with Celestial and Velocity Joint Observation for Lunar Rover[J]. Journal of Astronautics, 2009, 30(2):486-491 http://www.cnki.com.cn/Article/CJFDTOTAL-YHXB200902020.htm

    [6] 陈霞.天文/惯性组合导航模式研究[J].光学与光电技术, 2003, 1(3):21-24 http://youxian.cnki.com.cn/yxdetail.aspx?filename=BJHK20170309002&dbname=CAPJ2015

    Chen Xia. Investigation on Celestial/Integrated Navigation Patterns[J]. Optics & Optoelectronic Technology, 2003, 1(3):21-24 http://youxian.cnki.com.cn/yxdetail.aspx?filename=BJHK20170309002&dbname=CAPJ2015

    [7] 王保丰, 周建亮, 唐歌实, 等.嫦娥三号巡视器视觉定位方法[J].中国科学:信息科学, 2014, 44(4):452-460 http://www.cnki.com.cn/Article/CJFDTOTAL-PZKX201404003.htm

    Wang Baofeng, Zhou Jianliang, Tang Geshi, et al. Research on Visual Localization Method of Lunar Rover[J]. Science China:Information Sciences, 2014, 44(4):452-460 http://www.cnki.com.cn/Article/CJFDTOTAL-PZKX201404003.htm

    [8] 董光亮, 郝万宏, 李海涛, 等.同波束干涉测量对月面目标相对定位[J].清华大学学报(自然科学版), 2010, 50(7):1 118-1 124 http://www.cnki.com.cn/Article/CJFDTOTAL-QHXB201007034.htm

    Dong Guangliang, Hao Wanhong, Li Haitao, et al. Relative Position Determination on the Lunar Surface Using Same-beam Interferometry[J]. Journal of Tsinghua University:Science & Technology, 2010, 50(7):1 118-1 124 http://www.cnki.com.cn/Article/CJFDTOTAL-QHXB201007034.htm

    [9] 黄勇, 昌胜骐, 李培佳, 等. "嫦娥三号"月球探测器的轨道确定和月面定位[J].科学通报, 2014, 59(23):3 858-3 867 http://www.cnki.com.cn/Article/CJFDTOTAL-KXTB201423005.htm

    Huang Yong, Chang Shengqi, Li Peijia, et al. Orbit Determination of Chang'E-3 and Positioning of the Lander and the Rover[J]. Chin Sci Bull, 2014, 59(23):3 858-3 867 http://www.cnki.com.cn/Article/CJFDTOTAL-KXTB201423005.htm

    [10] 李培佳, 黄勇, 昌胜骐, 等.基于地基观测的嫦娥三号着陆器与巡视器高精度定位[J].科学通报, 2014, 59(32):3 162-3 173 http://www.cnki.com.cn/Article/CJFDTOTAL-KXTB201432007.htm

    Li Peijia, Huang Yong, Chang Sengqi, et al. Positioning for the Chang'E-3 lander and Rover Using Earth-based Observations [J]. Chin Sci Bull, 2014, 59(32): 3 162-3 173 http://www.cnki.com.cn/Article/CJFDTOTAL-KXTB201432007.htm

    [11] 潘超, 刘庆会, 郑鑫, 等.基于差分相时延的月球车速率测定和动作分析[J].天文学报, 2015, 56(4):353-361 http://www.cnki.com.cn/Article/CJFDTOTAL-TWXB201504005.htm

    Pan Chao, Liu Qinghui, Zheng Xin, et al. Speed Measurement and Motion Analysis of Chang'E-3 Rover Based on Differential Phase Delay [J]. Acta Astronomica Sinica, 2015, 56(4):353-361 http://www.cnki.com.cn/Article/CJFDTOTAL-TWXB201504005.htm

    [12]

    Liu Qinghui, Zheng Xin, Huang Yong, et al. Monitoring Motion and Measuring Relative Position of the Chang'E-3 Rover[J]. Radio Science. 2014, 49(11):1 080-1 086 doi: 10.1002/rds.v49.11

    [13] 杨淑洁, 杨功流, 尹洪亮, 等.一种航天飞行器的INS/CNS自主导航方案[J].中国惯性技术学报, 2014, 22(6):728-729 http://www.cnki.com.cn/Article/CJFDTOTAL-ZGXJ201406006.htm

    Yang Shujie, Yang Gongliu, Yin Hongliang, et al. Scheme Design of Autonomous Integrated INS/CNS Navigation Systems for Spacecraft [J]. Journal of Chinese Inertial Technology. 2014, 22(6):728-729 http://www.cnki.com.cn/Article/CJFDTOTAL-ZGXJ201406006.htm

    [14] 刘劲, 马杰, 田金文.基于MMAE-UKF的脉冲星/CNS组合导航[J].华中科技大学学报(自然科学版), 2009, 37(11):61-62 doi: 10.3321/j.issn:1671-4512.2009.11.016

    Liu Jing, Ma Jie, Tian Jinwen. Pulsar/CNS Integrated Navigation Using MMAE-UKF[J]. Journal of Huazhong University of Science and Technology(Natural Science Edition). 2009, 37(11):61-62 doi: 10.3321/j.issn:1671-4512.2009.11.016

    [15] 黄岸毅, 谢鑫, 张智斌, 等.同波束干涉测量在月面相对定位中的应用[J].测绘学报, 2015, 44(9):973-979 doi: 10.11947/j.AGCS.2015.20140142

    Huang Anyi, Xie Xin, Zhang Zhibin, et al. Application of the Same Beam Interferometry Measurement in Relative Position Determination on Lunar Surface[J]. Acta Geodaetica et Cartographica Sinica, 2015, 44(9):973-979. doi: 10.11947/j.AGCS.2015.20140142

    [16] 袁冬莉, 席庆彪, 阎建国.联邦卡尔曼滤波器在无人机导航系统中的应用[J].西北工业大学学报, 2002, 20(2):310-313 http://www.cnki.com.cn/Article/CJFDTOTAL-XBGD200202042.htm

    Yuan Dongli, Xi Qingbiao, Yan Jianguo, et al. A Globally Optimal GPS/RP/DR Navigation System for P.R. China's Remotely Piloted Vehicle (RPV) [J]. Journal of Northwestern Polytechnical University, 2002, 20(2):310-313. http://www.cnki.com.cn/Article/CJFDTOTAL-XBGD200202042.htm

    [17] 万德钧, 房建成, 王庆. GPS动态滤波的方法及其应用[M].南京:江苏科学技术出版社, 2000

    Wan Dejun, Fang Jiancheng, Wang Qing. Theory and Method of GPS Dynamic Filter and Application [M]. Nanjing: Jiangsu Science and Technology Press, 2000

    [18] 崔希璋, 於宗俦, 陶本藻, 等.广义测量平差[M].武汉:武汉大学出版社, 2009

    Cui Xizhang, Yu Zongchou, Tao Benzao, et al. Generalized Surveying Adjustment[M]. Wuhan: Wuhan University Press, 2009

    [19] 裴福俊, 居鹤华, 崔平远.基于联邦卡尔曼滤波的月球车自主导航方法[J].宇航学报, 2009, 30(4):1 429-1 433 http://youxian.cnki.com.cn/yxdetail.aspx?filename=WHCH201710014&dbname=CJFDPREP

    Pei Fujun, Ju Hehua, Cui Pingyuan. Autonomous Navigation Method Based on Federated Kalman Filter for Lunar Rover [J]. Journal of Astronautics, 2009, 30(4):1 429-1 433 http://youxian.cnki.com.cn/yxdetail.aspx?filename=WHCH201710014&dbname=CJFDPREP

  • 期刊类型引用(15)

    1. 肖泽辉,季青,庞小平,闫忠男. 利用海洋2B卫星数据反演南极海冰表面积雪厚度. 测绘地理信息. 2024(06): 64-68 . 百度学术
    2. 张颖,刘建强,石立坚,蒋城飞. 极地海冰观测卫星的发展现状与展望. 遥感技术与应用. 2024(06): 1339-1352 . 百度学术
    3. 陈国栋,陈钰,金涛勇,张志杰,李黎. 利用Cryosat-2 SAR模式数据确定北冰洋海平面模型. 大地测量与地球动力学. 2023(06): 606-611+621 . 百度学术
    4. 于亚冉,王丽华,张梦悦. 基于CryoSat-2的北极海冰类型分类. 测绘与空间地理信息. 2022(01): 147-150 . 百度学术
    5. 陈国栋,梁圣豪,孟子淇,朱家亨. 利用Cryosat-2数据确定格陵兰冰盖高程和体积变化. 苏州科技大学学报(自然科学版). 2022(01): 66-70+76 . 百度学术
    6. 屈猛,赵羲,庞小平,雷瑞波. 北极冰间水道区域的物理过程和遥感观测研究进展. 地球科学进展. 2022(04): 382-391 . 百度学术
    7. 高翔,庞小平,季青. 利用CryoSat-2测高数据研究南极威德尔海海冰出水高度时空变化. 武汉大学学报(信息科学版). 2021(01): 125-132 . 百度学术
    8. 张婷,张杰,张晰. 基于CryoSat-2数据的2014—2018年北极海冰厚度分析. 海洋科学进展. 2020(03): 425-434 . 百度学术
    9. 王志勇,王丽华,张晰,孙伟富,刘健. 雷达高度计在海冰厚度探测中的研究进展. 遥感信息. 2020(05): 1-8 . 百度学术
    10. 满富康,夏文韬,张杰,柯长青. 基于OSI-SAF微波遥感数据的北极一年冰和多年冰研究. 极地研究. 2019(01): 69-83 . 百度学术
    11. 吴星泉,张胜军,车德福. 利用CryoSat-2卫星测高资料确定北极海冰干舷高. 测绘通报. 2019(07): 64-68 . 百度学术
    12. 庞小平,刘清全,季青. 北极一年海冰表面积雪深度遥感反演与时序分析. 武汉大学学报(信息科学版). 2018(07): 971-977 . 百度学术
    13. 蒋广敏,戴利,代欣. 基于改进遗传算法的镀层氧化膜厚度测量研究. 周口师范学院学报. 2018(05): 121-124 . 百度学术
    14. 王蔓蔓,柯长青,邵珠德. 基于CryoSat-2卫星测高数据的北极海冰体积估算方法. 海洋学报. 2017(03): 135-144 . 百度学术
    15. 袁乐先,李斐,张胜凯,朱婷婷,左耀文. 利用ICESat/GLAS数据研究北极海冰干舷高度. 武汉大学学报(信息科学版). 2016(09): 1176-1182 . 百度学术

    其他类型引用(20)

图(3)  /  表(1)
计量
  • 文章访问数:  2713
  • HTML全文浏览量:  150
  • PDF下载量:  328
  • 被引次数: 35
出版历程
  • 收稿日期:  2016-08-15
  • 发布日期:  2017-10-04

目录

    /

    返回文章
    返回