搜索

x

留言板

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

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

基于广义M估计的鲁棒容积卡尔曼滤波目标跟踪算法

吴昊 陈树新 杨宾峰 陈坤

引用本文:
Citation:

基于广义M估计的鲁棒容积卡尔曼滤波目标跟踪算法

吴昊, 陈树新, 杨宾峰, 陈坤

Robust cubature Kalman filter target tracking algorithm based on genernalized M-estiamtion

Wu Hao, Chen Shu-Xin, Yang Bin-Feng, Chen Kun
PDF
导出引用
  • 为减小测量异常误差对非线性目标跟踪系统的影响, 提出了一种基于广义M估计的鲁棒容积卡尔曼滤波算法. 首先将非线性测量方程等价变换, 利用约束总体最小二乘准则构建广义M估计极值函数, 在不进行线性化近似的前提下将其引入到容积卡尔曼滤波求解框架中. 然后根据Mahalanobis距离构建异常误差判别量, 利用卡方分布的置信水平确定判决门限, 并建立改进的三段Huber权函数, 使其能够降低小异常误差权值, 剔除大异常误差. 理论分析表明, 该方法具有无需求导、跟踪精度高、实时性好等优点, 且无需已知异常误差的统计特性; 实验结果表明, 所提算法能够有效减小异常误差的影响, 在实际非线性物理系统中具有广阔的应用空间.
    Target tracking has been introduced as a key point in the physical applications, such as passive sonar and chaotic communication etc. It is typically a nonlinear filtering problem to estimate the position and the velocity of a target from noise-corrupted measurements. Some approaches have been proposed for the problem, such as the extended Kalman filter, the unscented Kalman filter, and the cubature Kalman filter (CKF). However, they are effective only in the Gaussian and white assumption for the measurements. Actually, the measurements are easily polluted by the measurement outliers in practice. The measurement outliers may lead to inaccurate performance due to non-symmetrical or non-Gaussian property. In order to cope with the measurement outliers in nonlinear target tracking system, a robust filtering algorithm called the M-estimation based robust cubature Kalman filter (MR-CKF) is proposed for the target tracking problem. Firstly, the nonlinear measurement equation is transformed into an equivalently linear form according to the orthogonal vector, and then the Gaussian extremal function of the target tracking can be obtained by the constrained total least square (CTLS) criterion. By employing the Huber's robust score function, the Gaussian extremal function is further rendered into a robust extremal function, thus the generalized M-estimation can be introduced to the CKF without linearization approximation. The only difference between the Gaussian extremal function and the robust extremal function is the weight matrix, implying that the CKF solution framework does not change and the virtues of both the CKF and M-estimation can be fully utilized such as derivative-free, high accuracy and robust performance. Furthermore, an improved Huber equivalent weight function is designed for the MR-CKF based on the Mahalanobis distance. The outliers' judge threshold is determined according to the confidence level of Chi-square distribution and improper empirical value of the Huber's method can be avoided. In addition, the improved Huber weight function reduces weights of small outliers and removes large outliers, and this is more robust and reasonable than the Huber's method. Moreover, the statistical information of outliers is also not required. Theoretical analysis and numerical results show that the proposed filtering algorithm can improve the accuracy and robustness than the conventional robust algorithms.
      通信作者: 吴昊, wuhaostudy@163.com
    • 基金项目: 国家自然科学基金(批准号: 51377172, 51107149)资助的课题.
      Corresponding author: Wu Hao, wuhaostudy@163.com
    • Funds: Project supported by the National Natural Science Foundation of China (Grant Nos. 51377172, 51107149).
    [1]

    Jwo D J, Yang C F, Chuang C H, Lee T Y 2013 Nonlinear Dyn. 73 377

    [2]

    Zhang Z T, Zhang J S 2010 Chin. Phys. B 19 104601

    [3]

    Sheng Z 2011 Acta Phys. Sin. 60 119301 (in Chinese) [盛峥 2011 物理学报 60 119301]

    [4]

    Hu Z H, Feng J C 2011 Acta Phys. Sin. 60 070505 (in Chinese) [胡志辉, 冯久超 2011 物理学报 60 070505]

    [5]

    Leong P H, Arulampalam S, Lamahewa T A, Abhayapala T D 2013 IEEE Trans. Aerosp. Electron. Syst. 49 1161

    [6]

    Chernodub A N 2014 Opt. Mem. Neural Netw. 23 96

    [7]

    Zhang Q, Qiao Y K, Kong X Y, Si X S 2014 Acta Phys. Sin. 63 110505 (in Chinese) [张琪, 乔玉坤, 孔祥玉, 司小胜 2014 物理学报 63 110505]

    [8]

    Wang X X, Pan Q, Huang H, Gao A 2012 Control and Decision 27 801 (in Chinese) [王小旭, 潘泉, 黄鹤, 高昂 2012 控制与决策 27 801]

    [9]

    Hu G G, Gao S S, Zhong Y M, Gao B B 2015 Chin. Phys. B 24 070202

    [10]

    Wang S Y, Feng J C, Tse C K 2014 IEEE Signal Process. Lett. 21 43

    [11]

    Zhang X C, Guo C J 2013 Chin. Phys. B 22 128401

    [12]

    Gerogiannis D P, Nikou C, Likas A 2015 IEEE Signal Process. Lett. 22 1638

    [13]

    Huber P J, Ronchetti E M 2009 Robust Statistics (Hoboken: John Wiley) p4

    [14]

    Chang G B, Liu M 2015 Nonlinear Dyn. 80 1431

    [15]

    Karlgaard C D, Schaub H 2011 J. Guid. Control Dyn. 34 388

    [16]

    Soken H E, Hajiyev C, Sakai S I 2014 Eur. J. Control 20 64

    [17]

    Wang X, Cui N, Guo J 2010 IET Radar Sonar Nav. 4 134

    [18]

    Zarei J, Shokri E 2014 Measurement 48 355

    [19]

    Chang L B, Hu B Q, Chang G B, Li A 2013 J. Process Control 23 1555

    [20]

    Abatzoglou T J, Mendel J M, Harada G A 1991 IEEE Trans. Signal Process. 39 1070

    [21]

    Izenman A J 2008 Modern multivariate statistical techniques: regression, classification, and manifold learning (Berlin: Springer) p60

    [22]

    Chang G B 2014 J. Geod. 88 391

    [23]

    Wang D, Zhang L, Wu Y 2007 Sci. China Ser. F: Inf. Sci. 50 576

  • [1]

    Jwo D J, Yang C F, Chuang C H, Lee T Y 2013 Nonlinear Dyn. 73 377

    [2]

    Zhang Z T, Zhang J S 2010 Chin. Phys. B 19 104601

    [3]

    Sheng Z 2011 Acta Phys. Sin. 60 119301 (in Chinese) [盛峥 2011 物理学报 60 119301]

    [4]

    Hu Z H, Feng J C 2011 Acta Phys. Sin. 60 070505 (in Chinese) [胡志辉, 冯久超 2011 物理学报 60 070505]

    [5]

    Leong P H, Arulampalam S, Lamahewa T A, Abhayapala T D 2013 IEEE Trans. Aerosp. Electron. Syst. 49 1161

    [6]

    Chernodub A N 2014 Opt. Mem. Neural Netw. 23 96

    [7]

    Zhang Q, Qiao Y K, Kong X Y, Si X S 2014 Acta Phys. Sin. 63 110505 (in Chinese) [张琪, 乔玉坤, 孔祥玉, 司小胜 2014 物理学报 63 110505]

    [8]

    Wang X X, Pan Q, Huang H, Gao A 2012 Control and Decision 27 801 (in Chinese) [王小旭, 潘泉, 黄鹤, 高昂 2012 控制与决策 27 801]

    [9]

    Hu G G, Gao S S, Zhong Y M, Gao B B 2015 Chin. Phys. B 24 070202

    [10]

    Wang S Y, Feng J C, Tse C K 2014 IEEE Signal Process. Lett. 21 43

    [11]

    Zhang X C, Guo C J 2013 Chin. Phys. B 22 128401

    [12]

    Gerogiannis D P, Nikou C, Likas A 2015 IEEE Signal Process. Lett. 22 1638

    [13]

    Huber P J, Ronchetti E M 2009 Robust Statistics (Hoboken: John Wiley) p4

    [14]

    Chang G B, Liu M 2015 Nonlinear Dyn. 80 1431

    [15]

    Karlgaard C D, Schaub H 2011 J. Guid. Control Dyn. 34 388

    [16]

    Soken H E, Hajiyev C, Sakai S I 2014 Eur. J. Control 20 64

    [17]

    Wang X, Cui N, Guo J 2010 IET Radar Sonar Nav. 4 134

    [18]

    Zarei J, Shokri E 2014 Measurement 48 355

    [19]

    Chang L B, Hu B Q, Chang G B, Li A 2013 J. Process Control 23 1555

    [20]

    Abatzoglou T J, Mendel J M, Harada G A 1991 IEEE Trans. Signal Process. 39 1070

    [21]

    Izenman A J 2008 Modern multivariate statistical techniques: regression, classification, and manifold learning (Berlin: Springer) p60

    [22]

    Chang G B 2014 J. Geod. 88 391

    [23]

    Wang D, Zhang L, Wu Y 2007 Sci. China Ser. F: Inf. Sci. 50 576

  • [1] 王重秋, 杨建华. 非周期二进制/M进制信号激励下非线性系统的非周期共振研究. 物理学报, 2023, 72(22): 222501. doi: 10.7498/aps.72.20231154
    [2] 张绿夷, 王革丽, 谭桂容, 吴越. 基于因果检验的非线性系统的预测试验. 物理学报, 2022, 71(8): 080502. doi: 10.7498/aps.71.20211871
    [3] 张识, 王攀, 张瑞浩, 陈红. 选取任意庞加莱截面的新方法. 物理学报, 2020, 69(4): 040503. doi: 10.7498/aps.69.20191585
    [4] 潘昕浓, 王革丽, 杨培才. 利用慢特征分析法提取层次结构系统中的外强迫. 物理学报, 2017, 66(8): 080501. doi: 10.7498/aps.66.080501
    [5] 李兆铭, 杨文革, 丁丹, 廖育荣. 逼近积分点数下限的五阶容积卡尔曼滤波定轨算法. 物理学报, 2017, 66(15): 158401. doi: 10.7498/aps.66.158401
    [6] 路永坤. 参数不确定统一混沌系统的鲁棒分数阶比例-微分控制. 物理学报, 2015, 64(5): 050503. doi: 10.7498/aps.64.050503
    [7] 逯志宇, 王大鸣, 王建辉, 王跃. 基于时频差的正交容积卡尔曼滤波跟踪算法. 物理学报, 2015, 64(15): 150502. doi: 10.7498/aps.64.150502
    [8] 杨芳艳, 胡明, 姚尚平. 连续时间系统同宿轨的搜索算法及其应用. 物理学报, 2013, 62(10): 100501. doi: 10.7498/aps.62.100501
    [9] 贾蒙, 樊养余, 李慧敏. 基于自适应因子轨道延拓法的不变流形计算. 物理学报, 2010, 59(11): 7686-7692. doi: 10.7498/aps.59.7686
    [10] 周颖, 臧强. 多输入多输出不确定非线性系统的输出反馈自适应机动控制. 物理学报, 2009, 58(11): 7565-7572. doi: 10.7498/aps.58.7565
    [11] 李文林, 宋运忠. 不确定非线性系统混沌反控制. 物理学报, 2008, 57(1): 51-55. doi: 10.7498/aps.57.51
    [12] 徐 云, 张建峡, 徐 霞, 周 红. Canard轨迹原理. 物理学报, 2008, 57(7): 4029-4033. doi: 10.7498/aps.57.4029
    [13] 秦卫阳, 苏 浩, 杨永峰. 利用Duffing系统的同步识别信号中的微小差别. 物理学报, 2008, 57(5): 2704-2707. doi: 10.7498/aps.57.2704
    [14] 马跃超, 黄丽芳, 张庆灵. 时变不确定时滞连续系统的鲁棒H∞保成本控制. 物理学报, 2007, 56(7): 3744-3752. doi: 10.7498/aps.56.3744
    [15] 马跃超, 张庆灵. 不确定广义组合大系统的分散输出反馈鲁棒镇定及脉冲分析. 物理学报, 2007, 56(4): 1958-1965. doi: 10.7498/aps.56.1958
    [16] 黄国勇, 姜长生, 王玉惠. 鲁棒terminal滑模控制实现一类不确定混沌系统同步. 物理学报, 2007, 56(11): 6224-6229. doi: 10.7498/aps.56.6224
    [17] 唐 晨, 闫海青, 张 皞, 刘 铭, 张桂敏. 任意阶隐式指数时程差分多步法及其在非线性系统中的应用. 物理学报, 2004, 53(6): 1699-1703. doi: 10.7498/aps.53.1699
    [18] 张必达, 王卫东, 宋枭禹, 俎栋林, 吕红宇, 包尚联. 磁共振现代射频脉冲理论在非均匀场成像中的应用. 物理学报, 2003, 52(5): 1143-1150. doi: 10.7498/aps.52.1143
    [19] 冷永刚, 王太勇. 二次采样用于随机共振从强噪声中提取弱信号的数值研究. 物理学报, 2003, 52(10): 2432-2437. doi: 10.7498/aps.52.2432
    [20] 唐 晨, 张 皞, 闫海青, 张桂敏. 非线性系统的任意项精细积分外插多步法及其在混沌数值分析中的应用. 物理学报, 2003, 52(5): 1091-1095. doi: 10.7498/aps.52.1091
计量
  • 文章访问数:  5370
  • PDF下载量:  375
  • 被引次数: 0
出版历程
  • 收稿日期:  2015-05-28
  • 修回日期:  2015-07-06
  • 刊出日期:  2015-11-05

/

返回文章
返回