算法比较
% 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
EKF,UKF,PF三种算法的比... 4页 1下载券EKF、UK...EKF、UKF、F 目标 跟踪性能的 比较 P万莉 刘 焰春 皮亦鸣 ,,(.子科技...
EKF_UKF_PF目标跟踪性能的比较_信息与通信_工程科技_专业资料。EKF_UKF_PF目标...0052 。 分别利用 U KF 和 PF 对该目标进行跟踪滤波 , 得到两种算法对距离...
6页 免费 目标定位跟踪算法及仿真程... 7页 免费 UKF算法滤波性能分析 11页 免费 EKF,UKF,PF三种算法的比较... 4页 2财富值搜...
ekf与ukf_计算机软件及应用_IT/计算机_专业资料。今日推荐 88份文档 2014...EKF,UKF,PF三种算法的比... 4页 1下载券 EKF与UKF在微型直升机姿... 6页...
龙源期刊网 http://www.qikan.com.cn ukf 和 ekf 跟踪滤波算法比较 作者:武振宁 李小艳 王伟 来源:《消费电子· 理论版》2013 年第 02 期 摘要:本文描述...
ukf和ekf跟踪滤波算法比较_交通运输_工程科技_专业资料 暂无评价
一种融合UKF和EKF的粒子滤波状态估计算法_于洪波_电子/电路_工程科技_专业资料。...跟踪效果比较结果, 可以看出使用 F 其次 PF 跟踪 效果与真实的状态最接近, 烄...
因为 为UKF算法的语句 程序 比EK KF算法多,所以解释执行起来就比较 较慢。而...6页 免费 UKF 10页 免费 EKF,UKF,PF三种算法的比... 4页 1下载券...
EKF-扩展卡尔曼滤波_专业资料。EKF-扩展卡尔曼滤波扩展卡尔曼滤波 卡尔曼滤波估计...EKF,UKF,PF三种算法的比... 4页 1下载券 利用扩展卡尔曼滤波算法... 5页...
UKF 在INS/GPS组合导航中 的应用 目录 INS/GPS组合导航简介 KF、EKF的不足 ...INS定位算法 ⊕ 位置速度 最优估计 伪距伪距率预测值 星历 ⊕ Kalman ▽ ...
热门文档