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

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

算法比较

%通过观测方程后的均值y_obse

u_y_obse = u_w_1 * u_y_2obser(1);

for i = 2 : u_total_number

u_y_obse = u_y_obse + u_w_N1 * u_y_2obser(i);

end

%Pzz测量方差矩阵

u_pzz = R + u_w_1 * (u_y_2obser(1)-u_y_obse)*(u_y_2obser(1)-u_y_obse)';

for i = 2 : u_total_number

u_pzz = u_pzz + u_w_N1 * (u_y_2obser(i) - u_y_obse)*(u_y_2obser(i) - u_y_obse)';

end

%Pxz状态向量与测量值的协方差矩阵

u_pxz = u_w_1 * (u_x_par(1) - u_x_next)* (u_y_2obser(1)-u_y_obse)';

for i = 2 : u_total_number

u_pxz = u_pxz + u_w_N1 * (u_x_par(i) - u_x_next) * (u_y_2obser(i)- u_y_obse)';

end

%卡尔曼增益

u_K = u_pxz/u_pzz;

%估计量的更新

u_x_next_optimal = u_x_next + u_K * (y - u_y_obse);%第一步的估计值+ 修正值;

u_x_estimate = u_x_next_optimal;

%方差的更新

u_p_next_update = u_p_next - u_K * u_pzz * u_K';

u_P = u_p_next_update;

%进行画图程序

x_array = [x_array,x];

e_x_estimate_array = [e_x_estimate_array,e_x_estimate];

p_x_estimate_array = [p_x_estimate_array,p_x_estimate];

u_x_estimate_array = [u_x_estimate_array,u_x_estimate];

e_error(k,:) = abs(x_array(k)-e_x_estimate_array(k));

p_error(k,:) = abs(x_array(k)-p_x_estimate_array(k));

u_error(k,:) = abs(x_array(k)-u_x_estimate_array(k));

end

t = 0 : tf;

figure;

plot(t,x_array,'k.',t,e_x_estimate_array,'r-',t,p_x_estimate_array,'g--',t,u_x_estimate_array,'b:'); set(gca,'FontSize',10);

set(gcf,'color','White');

xlabel('时间步长');% lable --->label 我的神

ylabel('状态');

legend('真实值','EKF估计值','PF估计值','UKF估计值');

上一页第4页

你可能喜欢

热门文档

相关文档

  • 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