文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 信息与通信 > EKF、UKF、PF算法的比较程序
侵权投诉

EKF、UKF、PF算法的比较程序

算法比较

e_H = e_x_estimate_1/10; %观测矩阵

%估计的误差

e_p_estimate = e_A * e_P * e_A' + Q;

%扩展卡尔曼增益

e_K = e_p_estimate * e_H'/(e_H * e_p_estimate * e_H' + R);

%进行估计值的更新 第二阶段

e_x_estimate_2 = e_x_estimate_1 + e_K * (y - e_y_estimate);

%更新后的估计值的误差

e_p_estimate_update = e_p_estimate - e_K * e_H * e_p_estimate;

%进入下一次迭代的参数变化

e_P = e_p_estimate_update;

e_x_estimate = e_x_estimate_2;

% 粒子滤波器

% 粒子滤波器

for i = 1 : N

p_xpartminus(i) = 0.5 * p_xpart(i) + 25 * p_xpart(i) / (1 + p_xpart(i)^2) + 8 * cos(1.2*(k-1)

) + sqrtQ) * randn; %这个式子比下面一行的效果好

% xpartminus(i) = 0.5 * xpart(i) + 25 * xpart(i) / (1 + xpart(i)^2) + 8 * cos(1.2*(k-1));

p_ypart = p_xpartminus(i)^2 / 20; %预测值

p_vhat = y - p_ypart;% 观测和预测的差

p_q(i) = (1 / sqrt(R) / sqrt(2*pi)) * exp(-p_vhat^2 / 2 / R); %各个粒子的权值

end

% 平均每一个估计的可能性

p_qsum = sum(p_q);

for i = 1 : N

p_q(i) = p_q(i) / p_qsum;%各个粒子进行权值归一化

end

% 重采样 权重大的粒子多采点,权重小的粒子少采点, 相当于每一次都进行重采样; for i = 1 : N

p_u = rand;

p_qtempsum = 0;

for j = 1 : N

p_qtempsum = p_qtempsum + p_q(j);

if p_qtempsum >= p_u

p_xpart(i) = p_xpartminus(j); %在这里xpart(i) 实现循环赋值;终于找到了这里!

break;

end

end

end

p_x_estimate = mean(p_xpart);

% p_x_estimate = 0;

% for i = 1 : N

上一页第2页

你可能喜欢

热门文档

相关文档

  • EKF、UKF、PF目标跟踪性能的比较

    EKF,UKF,PF三种算法的比... 4页 1下载券EKF、UK...EKF、UKF、F 目标 跟踪性能的 比较 P万莉 刘 焰春 皮亦鸣 ,,(.子科技...

  • EKF_UKF_PF目标跟踪性能的比较

    EKF_UKF_PF目标跟踪性能的比较_信息与通信_工程科技_专业资料。EKF_UKF_PF目标...0052 。 分别利用 U KF 和 PF 对该目标进行跟踪滤波 , 得到两种算法对距离...

  • 多被动传感器UKF与EKF算法的应用与比较

    6页 免费 目标定位跟踪算法及仿真程... 7页 免费 UKF算法滤波性能分析 11页 免费 EKF,UKF,PF三种算法的比较... 4页 2财富值搜...

  • ekf与ukf

    ekf与ukf_计算机软件及应用_IT/计算机_专业资料。今日推荐 88份文档 2014...EKF,UKF,PF三种算法的比... 4页 1下载券 EKF与UKF在微型直升机姿... 6页...

  • ukf和ekf跟踪滤波算法比较

    龙源期刊网 http://www.qikan.com.cn ukf 和 ekf 跟踪滤波算法比较 作者:武振宁 李小艳 王伟 来源:《消费电子· 理论版》2013 年第 02 期 摘要:本文描述...

  • 【论文】ukf和ekf跟踪滤波算法比较

    ukf和ekf跟踪滤波算法比较_交通运输_工程科技_专业资料 暂无评价

  • 一种融合UKF和EKF的粒子滤波状态估计算法_于洪波

    一种融合UKF和EKF的粒子滤波状态估计算法_于洪波_电子/电路_工程科技_专业资料。...跟踪效果比较结果, 可以看出使用 F 其次 PF 跟踪 效果与真实的状态最接近, 烄...

  • EKF与UKF在微型直升机姿态估计中的比较

    因为 为UKF算法的语句 程序 比EK KF算法多,所以解释执行起来就比较 较慢。而...6页 免费 UKF 10页 免费 EKF,UKF,PF三种算法的比... 4页 1下载券...

  • EKF-扩展卡尔曼滤波

    EKF-扩展卡尔曼滤波_专业资料。EKF-扩展卡尔曼滤波扩展卡尔曼滤波 卡尔曼滤波估计...EKF,UKF,PF三种算法的比... 4页 1下载券 利用扩展卡尔曼滤波算法... 5页...

  • UKF的原理

    UKF 在INS/GPS组合导航中 的应用 目录 INS/GPS组合导航简介 KF、EKF的不足 ...INS定位算法 ⊕ 位置速度 最优估计 伪距伪距率预测值 星历 ⊕ Kalman ▽ ...

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email