基于自适应强跟踪CQKF的目标跟踪算法

doi:10.13700/j.bh.1001-5965.2017.0312

北京航空航天大学学报 ›› 2018, Vol. 44 ›› Issue (5): 982-990.doi: 10.13700/j.bh.1001-5965.2017.0312

基于自适应强跟踪CQKF的目标跟踪算法

刘畅¹, 杨锁昌¹, 汪连栋², 张宽桥¹

1. 军械工程学院导弹工程系, 石家庄 050000;
2. 电子信息系统复杂电磁环境效应国家重点实验室, 洛阳 471003

收稿日期:2017-05-15 出版日期:2018-05-20 发布日期:2018-05-29
通讯作者: 杨锁昌 E-mail:yangsuochang_jx@sina.com
作者简介:刘畅,男,博士研究生。主要研究方向:非线性滤波、目标跟踪;杨锁昌,男,博士,教授,博士生导师。主要研究方向:导弹制导。

Target tracking algorithm based on adaptive strong tracking CQKF

LIU Chang¹, YANG Suochang¹, WANG Liandong², ZHANG Kuanqiao¹

1. Department of Missile Engineering, Ordnance Engineering College, Shijiazhuang 050000, China;
2. State Key Laboratory of Complex Electromagnetic Environment Effects on Electronics and Information System, Luoyang 471003, China

Received:2017-05-15 Online:2018-05-20 Published:2018-05-29

摘要/Abstract

摘要： 针对容积积分卡尔曼滤波（CQKF）受模型不确定性影响较大及需要精确已知噪声统计特性的缺点，提出了一种自适应强跟踪CQKF算法。该算法根据强跟踪滤波原理，引入渐消因子调整状态预测协方差矩阵，强迫残差序列正交，有效抑制了模型不确定性引起的滤波发散。在滤波过程中，利用Sage-Husa时变噪声统计估值器对过程噪声及量测噪声实时估计，提高了算法在未知时变噪声环境下的滤波精度。目标跟踪仿真实验验证了算法的有效性和鲁棒性。

关键词: 目标跟踪, 容积积分卡尔曼滤波(CQKF), 强跟踪滤波, 噪声统计估值器, 自适应滤波

Abstract: As cubature quadrature Kalman filter (CQKF) is easily influenced by uncertainty of state-space model and need to know exactly noise statistics, a new type of adaptive CQKF algorithm with strong tracking behavior is proposed. Based on the theory of strong tracking filter, the new algorithm introduces fading factor to adapt to covariance matrix and reinforces residual sequence to be orthogonal, which effectively suppresses the filtering divergence caused by the model uncertainty. In the process of filtering, processing noise and measurement noise should be estimated online by the Sage-Husa noise statistics estimator, which will improve the filter precision under the circumstance of unknown time-varying noise. Simulations of target tracking demonstrate the efficiency and robustness of the algorithm. Received:2017-05-15; Accepted:2017-06-26; Published online:2017-10-13 14:05 URL:kns.cnki.net/kcms/detail/11.2625.V.20171013.1405.004.html *Corresponding author. E-mail:yangsuochang_jx@sina.com

Key words: target tracking, cubature quadrature Kalman filter (CQKF), strong tracking filter, noise statistics estimators, adaptive filter

中图分类号:

TN953

刘畅, 杨锁昌, 汪连栋, 张宽桥. 基于自适应强跟踪CQKF的目标跟踪算法[J]. 北京航空航天大学学报, 2018, 44(5): 982-990.

LIU Chang, YANG Suochang, WANG Liandong, ZHANG Kuanqiao. Target tracking algorithm based on adaptive strong tracking CQKF[J]. JOURNAL OF BEIJING UNIVERSITY OF AERONAUTICS AND A, 2018, 44(5): 982-990.

参考文献

[1] KALMAN R E.A new approach to linear filtering and prediction theory[J].Transactions on ASME Journal of Basic Engineering,1960,82(D):35-46.
[2] JAZWINSKI A H.Stochastic processes and filtering theory[M].New York:Academic Press,1970:235-237.
[3] 李天成,范红旗.孙树栋.粒子滤波理论、方法及其在多目标跟踪中的应用[J].自动化学报,2015,41(12):1981-2002.LI T C,FAN H Q,SUN S D.Particle filtering:Theory,approach,and application for multitar-get tracking[J].Acta Automatica Sinica,2015,41(12):1981-2002(in Chinese).
[4] 韩萍,干浩亮,何炜琨,等.基于迭代中心差分卡尔曼滤波的飞机姿态估计[J].仪器仪表学报,2015,36(1):187-193.HAN P,GAN H L,HE W K,et al.Iterated central difference Kalman filter based aircraft attitude estimation[J].Chinese Journal of Scientific Instrument,2015,36(1):187-193(in Chinese).
[5] 王宝宝,吴盘龙. 基于平方根无迹卡尔曼滤波平滑算法的水下纯方位目标跟踪[J].中国惯性技术学报,2016,24(2):180-184.WANG B B,WU P L.Underwater bearing-only tracking based on square-root unscented Kalman filter smoothing algorithm[J].Journal of Chinese Inertial Technology,2016,24(2):180-184(in Chinese).
[6] 张龙,崔乃刚,杨峰,等.高阶容积卡尔曼滤波及其在目标跟踪中的应用[J].哈尔滨工程大学学报,2016,37(4):573-578.ZHANG L,CUI N G,YANG F,et al.High-degree cubature Kalman filter and its application in target tracking[J].Journal of Harbin Engineering University,2016,37(4):573-578(in Chinese).
[7] BHAUMIK S,WATI S.Cubature quarature Kalman filter[J]. IET Signal Processing,2013,7(7):533-541.
[8] LAINIOTIS D G.Optimal adaptive estimation:Structure and parameters adaption[J].IEEE Transactions on Automatic Control,1971,16(2):160-170.
[9] MEHRA R K. On the identification of variances and adaptive filtering[J].IEEE Transactions on Automatic Control,1970,15(2):175-184.
[10] ODELSON B J,RAJAMANI M R,RAWLINGS J B.A new autocovariance least-squares method for estimating noise covariances[J].Automatica, 2006,42(2):303-308.
[11] AKESSON B M,JORGENSON J B,POULSEN N K,et al.A generalized autocovariance least-squares method for Kalman filter tuning[J].Journal of Process Control,2008,18(7-8):769-779.
[12] MYERS K A,TAPLEY B D.Adaptive sequential estimation with unknown noise statistics[J].IEEE Transactions on Automatic Control,1976,21(8):520-523.
[13] KASHYAP R L.Maximum likelihood identification of stochastic linear systems[J].IEEE Transactions on Automatic Control,1970,15(1):25-34.
[14] LIMA F V, RAJAMANI M R, SODERSTROM T A,et al.Covariance and state estimation of weakly observable systems:Application to polymerization processes[J].IEEE Transactions on Control Systems Technology,2013,21(4):1249-1257.
[15] 李宁,祝瑞辉,张勇刚.基于Sage-Husa算法的自适应平方根CKF目标跟踪方法[J].系统工程与电子技术,2014,36(10):1899-1905.LI N,ZHU R H,ZHANG Y G.Adaptive square CKF method for target tracking based on Sage-Husa algorithm[J].Systems Engineering and Electronics,2014,36(10):1899-1905(in Chinese).
[16] 王小旭,潘泉,黄鹤,等.非线性系统确定采样型滤波算法综述[J].控制与决策,2012,27(6):801-812.WANG X X,PAN Q,HUANG H,et al.Overview of deterministic sampling filtering algorithms for nonlinear system[J].Control and Decision,2012,27(6):801-812(in Chinese).
[17] 周东华,席裕庚,张钟俊.一种带多重次优渐消因子的扩展卡尔曼滤波器[J].自动化学报,1991,17(6):689-695.ZHANG D H,XI Y G,ZHANG Z J.A suboptimal multiple fading extended Kalman filter[J].Acta Automatica Sinica, 1991,17(6):689-695(in Chinese).
[18] 方君,戴邵武,许文明,等.基于ST-SRCKF的超高速强机动目标跟踪算法[J].北京航空航天大学学报,2016,42(8):1698-1708.FANG J,DAI S W,XU W M,et al.Highly maneuvering hypervelocity-target tracking algorithm based on ST-SRCKF[J].Journal of Beijing University of Aeronautics and Astronautics,2016,42(8):1698-1708(in Chinese).
[19] 张龙,崔乃刚,王小刚,等.强跟踪-容积卡尔曼滤波在弹道式再入目标跟踪中的应用[J].中国惯性技术学报,2015,23(2):211-218.ZHANG L,CUI N G,WANG X G,et al.Strong tracking-cubature Kalman filter for tracking ballistic reentry target[J].Journal of Chinese Inertial Technology,2015,23(2):211-218(in Chinese).
[20] 赵琳,王小旭,孙明,等.基于极大后验估计和指数加权的自适应UKF滤波算法[J].自动化学报,2010,36(7):1007-1019.ZHAO L,WANG X X,SUN M,et al.Adaptive UKF filteing algorithm based on maximum a posterior estimation and exponential weighting[J].Acta Automatica Sinica,2010,36(7):1007-1019(in Chinese).
[21] 丁家琳,肖建,赵涛.自适应CKF强跟踪滤波器及其应用[J].电机与控制学报,2015,19(11):111-120.DING J L,XIAO J,ZHAO T.Adaptive CKF strong tracking filter and application[J].Electric Machines and Control,2015,19(11):111-120(in Chinese).

基于自适应强跟踪CQKF的目标跟踪算法

Target tracking algorithm based on adaptive strong tracking CQKF

PDF (PC)

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	何康辉, 董朝阳, 王青. 一种考虑GPS信号中断的导航滤波算法[J]. 北京航空航天大学学报, 2019, 45(9): 1874-1881.
[2]	庞策, 单甘霖, 段修生. 多传感器协同识别跟踪多目标管理方法[J]. 北京航空航天大学学报, 2019, 45(8): 1674-1680.
[3]	李惠峰, 易文峰, 程晓明. 基于近似动态规划的目标追踪控制算法[J]. 北京航空航天大学学报, 2019, 45(3): 597-605.
[4]	肖楚晗, 李炯, 雷虎民, 王华吉. 基于AVSIMM算法的高超声速再入滑翔目标跟踪[J]. 北京航空航天大学学报, 2019, 45(2): 413-421.
[5]	欧能杰, 汪圣利, 张直. 基于非等维状态的IMM混合估计方法[J]. 北京航空航天大学学报, 2019, 45(10): 2115-2122.
[6]	王国宏, 白杰, 孙殿星. 速度欺骗干扰下的机动目标跟踪技术[J]. 北京航空航天大学学报, 2018, 44(7): 1359-1370.
[7]	周卫东, 刘璐, 唐佳. 基于模糊逻辑的交互式多模型滤波算法[J]. 北京航空航天大学学报, 2018, 44(3): 413-419.
[8]	赵玉龙, 沈怀荣, 任元. 超流体陀螺相位波动噪声自适应抵消系统分析[J]. 北京航空航天大学学报, 2018, 44(3): 508-515.
[9]	张凯, 熊家军, 付婷婷, 席秋实. 基于耦合气动参数的HGV多模型估计[J]. 北京航空航天大学学报, 2018, 44(10): 2156-2164.
[10]	甘林海, 刘进忙, 王刚, 李松. 多模型GGIW-GLMB算法跟踪机动群目标[J]. 北京航空航天大学学报, 2018, 44(10): 2185-2192.
[11]	朱日东, 杨小远, 王敬凯. 基于傅里叶域卷积表示的目标跟踪算法[J]. 北京航空航天大学学报, 2018, 44(1): 151-159.
[12]	滑维鑫, 慕德俊, 郭达伟, 刘航. 基于目标性权值度量的多示例学习目标跟踪[J]. 北京航空航天大学学报, 2017, 43(7): 1364-1372.
[13]	刘玉双, 赵剡, 吴发林. 基于外定界椭球集员估计的纯方位目标跟踪[J]. 北京航空航天大学学报, 2017, 43(3): 497-505.
[14]	汪溁鹤, 陈裕雄, 马世龙, 吕江花. 实时鲁棒的频域空间目标跟踪方法[J]. 北京航空航天大学学报, 2017, 43(12): 2457-2465.
[15]	袁常顺, 王俊, 向洪, 魏少明, 张耀天. 非线性量测下自适应噪声协方差PHD滤波[J]. 北京航空航天大学学报, 2017, 43(1): 53-60.