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

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

魏二虎, 汤深权, 刘建栋, 董翠军. 基于联邦卡尔曼滤波的月球车联合定位方法[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

  • 期刊类型引用(8)

    1. 李昊,马友青,张烁,刘少创. “祝融号”火星车驶离着陆平台决策支持几何参数计算方法. 中国科学院大学学报. 2024(01): 81-87 . 百度学术
    2. 张烁,温博,张建利,亓晨,彭松,刘少创,贾阳,鄢咏折,马友青,杨欢,李昊,吴运佳,谢婉蓉. “祝融号”火星车立体视觉系统的几何自检校. 测绘学报. 2023(05): 780-788 . 百度学术
    3. 马友青,郑燕红,金晟毅,张烁,鄢咏折,吴运佳,刘少创. 基于嫦娥五号探测器立体监视相机图像的高精度地形重建试验研究. 中国科学:技术科学. 2022(10): 1509-1520 . 百度学术
    4. 郑燕红,邓湘金,顾征,金晟毅,李青. 嫦娥五号月面表取采样点选择. 光学精密工程. 2021(12): 2935-2943 . 百度学术
    5. 马友青,彭松,温博,贾阳,申振荣,亓晨,张烁,杨欢,司马兵,王楷文,刘少创. 基于嫦娥四号月球车图像的地形遮挡高精度预报试验研究. 中国科学:技术科学. 2020(01): 54-68 . 百度学术
    6. 崔红霞,陈丽君,王宁,李婷婷. 基于标志自动编码的多视组合相机隐式约束标定方法. 中国激光. 2020(01): 279-288 . 百度学术
    7. 付兵杰,赵双明,喻国荣,赵帅华. 一种无需控制信息的智能手机自检校方法. 武汉大学学报(信息科学版). 2019(02): 268-275+282 . 百度学术
    8. 郭丽,李金岭,童锋贤,王广利,黄飞,刘庆会,郑鑫,郑为民. 同波束VLBI技术对嫦娥三号巡视器的高精度相对定位. 武汉大学学报(信息科学版). 2016(08): 1125-1130 . 百度学术

    其他类型引用(2)

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

目录

    /

    返回文章
    返回