测绘学报 ›› 2015, Vol. 44 ›› Issue (9): 945-951.doi: 10.11947/j.AGCS.2015.20140492

• 大地测量学与导航 •    下一篇

自适应抗差Kalman滤波在多天线原始观测值瞬时姿态确定中的应用

甘雨, 隋立芬, 刘长建, 董明   

  1. 信息工程大学地理空间信息学院, 河南 郑州 450000
  • 收稿日期:2014-09-24 修回日期:2015-05-14 出版日期:2015-09-24 发布日期:2015-09-24
  • 作者简介:甘雨(1988—),男,博士生,研究方向为GNSS定位测姿、组合导航。E-mail:ganyu099@163.com
  • 基金资助:
    国家自然科学基金(41274016;40974010);地理信息工程国家重点实验室重点基金(SKLGIE2014-Z-2-1)

Instantaneous Attitude Determination Based on Original Multi-antenna Observations Using Adaptively Robust Kalman Filtering

GAN Yu, SUI Lifen, LIU Changjian, DONG Ming   

  1. Institute of Surveying and Mapping, Information Engineering University, Zhengzhou 450000, China
  • Received:2014-09-24 Revised:2015-05-14 Online:2015-09-24 Published:2015-09-24
  • Supported by:
    The National Natural Science Foundation of China(Nos.41274016;40974010);Key Fund of Geographic Information Engineering National Key Laboratory(No.SKLGIE2014-Z-2-1)

摘要: 由载波相位观测值直接解算姿态能实现观测及姿态约束信息的最优利用。本文推导了基于失准角及乘性误差四元数的载波相位观测模型,分别建立了有外部角速度传感器和无外部传感器辅助下姿态参数估计的状态模型;利用自适应抗差滤波估计姿态误差,借鉴分类自适应因子的思想,分别确定模糊度和姿态误差参数的自适应因子,其中姿态自适应因子由Ratio值构造的三段函数确定。自适应抗差滤波能够充分利用约束信息和历史信息,将其融合在浮点解计算过程中,极大提高模糊度浮点解精度及其协方差的结构,在此基础上使用整数最小二乘模糊度降相关平差法(least-squares ambiguity decorrelation adjustment,LAMBDA)方法即能快速搜索出固定解,满足实时性需求。采用实测舰载GNSS 3天线测姿算例对方法进行了验证,结果表明,基于自适应抗差滤波的观测值直接定姿方法效率高、可靠性好。

关键词: 自适应抗差滤波, 分类自适应因子, 多天线, 瞬时解算, 误差四元数, 失准角

Abstract: Attitude determination directly by carrier phase observation makes optimal use of observation and attitude constraints. The phase models based on misalignment angle and multiplicative quaternion error are derived. The state models for attitude estimation with and without external angular rate sensors are both erected. The attitude errors are estimated by adaptively robust filtering, in which the adaptive factors of ambiguity and attitude error are decided respectively following the idea of multi adaptive factor filtering. The factor of attitude is determined by a three-section function containing Ratio. Adaptively robust filtering makes the best use of constraint and historical information, fusing them in the calculation of float solution. As the accuracy of float solution and the structure of covariance matrix are improved greatly, the fix solution can be searched efficiently using LAMBDA (least-squares ambiguity decorrelation adjustment) method merely, perfectly fulfilling the real-time requirement. Field test of a ship-based three-antenna attitude system is used to validate the proposed method. It is showed that direct attitude determination based on adaptively robust filtering has obvious advantages in efficiency and reliability.

Key words: adaptively robust filtering, multi adaptive factors, multi-antennas, instantaneous resolution, quaternion error, misalignment angle

中图分类号: