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

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

算法比较

% p_x_estimate =p_x_estimate + p_q(i)*p_xpart(i);

% end

%不敏卡尔曼滤波器

%采样点的选取存在x(i)

u_x_par = u_x_estimate;

for i = 2 : (u_symmetry_number+1)

u_x_par(i,:) = u_x_estimate + sqrt((u_symmetry_number+u_k) * u_P);

end

for i = (u_symmetry_number+2) : u_total_number

u_x_par(i,:) = u_x_estimate - sqrt((u_symmetry_number+u_k) * u_P);

end

%计算权值

u_w_1 = u_k/(u_symmetry_number+u_k);

u_w_N1 = 1/(2 * (u_symmetry_number+u_k));

%把这些粒子通过传递方程得到下一个状态

for i = 1: u_total_number

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

end

%传递后的均值和方差

u_x_next = u_w_1 * u_x_par(1);

for i = 2 : u_total_number

u_x_next = u_x_next + u_w_N1 * u_x_par(i);

end

u_p_next = Q + u_w_1 * (u_x_par(1)-u_x_next) * (u_x_par(1)-u_x_next)';

for i = 2 : u_total_number

u_p_next = u_p_next + u_w_N1 * (u_x_par(i)-u_x_next) * (u_x_par(i)-u_x_next)';

end

% %对传递后的均值和方差进行采样产生粒子存在y(i)

% u_y_2obser(1) = u_x_next;

% for i = 2 : (u_symmetry_number+1)

% u_y_2obser(i,:) = u_x_next + sqrt((u_symmetry_number+k) * u_p_next);

% end

% for i = (u_symmetry_number + 2) : u_total_number

% u_y_2obser(i,:) = u_x_next - sqrt((u_symmetry_number+u_k) * u_p_next);

% end

%另外存在y_2obser(i) 中;

for i = 1 :u_total_number

u_y_2obser(i,:) = u_x_par(i);

end

%通过观测方程得到一系列的粒子

for i = 1: u_total_number

u_y_2obser(i) = u_y_2obser(i)^2/20;

end

上一页第3页

你可能喜欢

热门文档

相关文档

  • 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