目标跟踪常用算法——CKF篇

目录

1.容积卡尔曼滤波算法

1.1 容积卡尔曼滤波算法简单介绍

1.2 容积卡尔曼滤波算法流程

1.3 容积卡尔曼滤波算法仿真分析

2.参考文献


1.容积卡尔曼滤波算法

1.1 容积卡尔曼滤波算法简单介绍

容积卡尔曼滤波(Cubature Kalman Filter,CKF)算法是新提出的一种非线性滤波算法,解决了高维系统滤波估计效果较差的问题。容积卡尔曼滤波与无迹卡尔曼滤波相似,但克服了UKF高维系统处理的问题。CKF算法基于贝叶斯滤波基础,通过选取一组容积点来近似计算函数的均值与协方差,降低了非线性函数线性化的误差。CKF算法基于数值积分理论来计算高斯积分,具有数值精度高的特点。

1.2 容积卡尔曼滤波算法流程

1.3 容积卡尔曼滤波算法仿真分析

仿真条件:

假设一目标在二维平面内做匀速直线运动,观测站处于原点且保持静止,无站址误差。观测站可以实时测量到目标与观测站之间的距离以及方位角(北偏东)。蒙特卡洛仿真100次,并将RMSE与CRLB进行对比。

目标初始状态

量测误差

过程噪声

二维

(-1000m,1000m,20m/s,-8m/s)

100m,1°

1e-4m/s2

2.参考文献

陈燕平. 基于容积卡尔曼滤波的目标跟踪研究 [D]; 电子科技大学, 2021.

  • 7
    点赞
  • 20
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
收到一些国内外朋友的来信,咨询关于容积卡尔曼滤波的问题(CKF),大家比较疑惑的应该就是generator或G-orbit的概念。考虑到工作以后,重心必然转移,不可能再像现在这样详细的回答所有人的问题,更不可能再帮大家改论文、写(或改)代码了,请各位谅解!在此,上传一个CKF和五阶CKF用于目标跟踪的示例代码,代码中包含详细的注释,希望对大家以后的学习和研究有所帮助! 此代码利用C++对五阶CKF的第二G-轨迹进行了封装(Perms.exe),能理解最好,如果无法理解,也无须深究其具体构造方法!可执行文件底层是用字符串+递归算法实现的,理论上可以应用于任意维模型。但考虑到递归算法可能存在的栈溢出,重复压栈出栈带来的时间消耗等问题,我们利用矩阵的稀疏性和群的完全对称性,并通过分次调用,来尽可能减少栈的深度,提高计算速度。 容积点一次生成后,可以一直使用,通过对50维G-轨迹的生成速度(Core T6600@2.2GHz)进行测试,包含数据读写在内的速度约为1.5秒,速度尚可。而目前为止,本人尚未遇到达到甚至超过50维的系统,因此,暂时不作算法层面的优化。 注意:Perms.exe可以用于任意维模型,将可执行文件复制至工作目录下,调用时选择N/n,并输入你的模型维数,即可生成所需的第二G-轨迹。如果无法理解相关的概念,请参考示例代码,并记住如何使用即可~~~ 相关理论基础及所用模型,请参考以下文献: References (you may cite one of the articles in your paper): [1] X. C. Zhang, C. J. Guo, "Cubature Kalman filters: Derivation and extension," Chinses Physics B, vol.22, no.12, 128401, DOI: 10.1088/1674-1056/22/12/128401 [2] X. C. Zhang, Y. L. Teng, "A new derivation of the cubature Kalman filters," Asian Journal of Control, DOI: 10.1002/asjc.926 [3] X. C. Zhang, "Cubature information filters using high-degree and embedded cubature rules," Circuits, Systems, and Signal Processing,vol.33, no.6,pp.1799-1818,DOI: 10.1007/s00034-013-9730-0
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

Nickyfks

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值