算法比较
%通过观测方程后的均值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估计值');
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 ▽ ...
热门文档