博客
关于我
扩展卡尔曼滤波(1)-----非线性处理
阅读量:562 次
发布时间:2019-03-09

本文共 1537 字,大约阅读时间需要 5 分钟。

EKF的运用

基本原理

以下图片来自何子述老师的《现代数字信号处理及其运用》

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

例子

在这里插入图片描述

源代码

%  函数功能:标量非线性系统扩展Kalman滤波问题%  状态函数:X(k+1)=0.5X(k)+2.5X(k)/(1+X(k)^2)+8cos(1.2k) +w(k)%  观测方程:Z(k)=X(k)^2/20+v(k)clc;clear all;close all;%---------参数设置N=100;    % 仿真次数t=0:N-1;  % 仿真时间%-----------系统状态噪声、观测噪声Q1=0.1;   % Q1的值改变,观察不同Q1值时滤波结果Q2=10;    % 测量噪声        v1=sqrt(Q1)*randn(1,N);% 产生过程噪声v2=sqrt(Q2)*randn(1,N);% 产生观测噪声%---------初始化X=zeros(1,N);       % 状态方程初始化X(1)=0.1;Z=zeros(1,N);       % 输出方程初始化Z(1)=X(1)^2/20+v2(1);P0=eye(1);          % 协方差阵初始化X_est=zeros(1,N);   % 卡尔曼估计状态X_est(1)=X(1);      % 卡尔曼滤波状态给初值X_err=zeros(1,N);   % 误差值初始化X_err(1)=0;         % 误差值初始值为0 for n=2:N %数字信号处理P263    % 状态方程    X(n)=0.5*X(n-1)+2.5*X(n-1)/(1+X(n-1)^2)+8*cos(1.2*n)+v1(n-1);    % 观测方程    Z(n)=X(n)^2/20+v2(n);        %------开始卡尔曼滤波过程    % 步骤1:状态一步预测    X_pre=0.5*X_est(n-1)+2.5*X_est(n-1)/(1+X_est(n-1)^2)+8*cos(1.2*n);        % 步骤2:一步预测误差自相关矩阵    F_pre=0.5+2.5 *(1-X_pre^2)/(1+X_pre^2)^2;  % 状态转移矩阵更新 % 具体见7.5.1     P_pre=F_pre*P0*F_pre'+Q1;        % 步骤3:卡尔曼增益     C=X_pre/10; % 观测矩阵  % 具体见7.5.2       K=P_pre*C'*inv(C*P_pre*C'+Q2);        % 步骤4:状态估计    Zn=X_pre^2/20;% 观测预测  ^2/20是函数h    X_est(n)=X_pre+K*(Z(n)-Zn);  % 具体见教材P263        % 步骤5:状态估计误差自相关矩阵    P0=(1-K*C)*P_pre;        %---------误差分析    X_err(n)=abs( X_est(n)-X(n) );end%-----------画图figure(1)plot(t,X,'-ro');hold on;grid on;plot(t,Z,'-.');hold on;grid on;plot(t,X_est,'-b*');hold on;grid on;xlabel('观察时间');legend('真实的状态值','观测值','卡尔曼滤波后的值')figure(2)plot(t,X_err,'-b*');hold on;grid on;xlabel('观察时间');ylabel('误差值');title('误差图');

结果分析

在这里插入图片描述

在这里插入图片描述

转载地址:http://rnapz.baihongyu.com/

你可能感兴趣的文章
Mysql学习总结(6)——MySql之ALTER命令用法详细解读
查看>>
Mysql学习总结(70)——MySQL 优化实施方案
查看>>
Mysql学习总结(71)——MySQL 重复记录查询与删除总结
查看>>
Mysql学习总结(71)——数据库介绍(MySQL安装 体系结构、基本管理)再回顾
查看>>
Mysql学习总结(72)——MySQL 开发者开发,设计规范再总结
查看>>
Mysql学习总结(73)——MySQL 查询A表存在B表不存在的数据SQL总结
查看>>
Mysql学习总结(74)——慢SQL!压垮团队的最后一根稻草!
查看>>
Mysql学习总结(75)——并发量大、数据量大的互联网业务数据库设计军规
查看>>
Mysql学习总结(76)——MySQL执行计划(explain)结果含义总结
查看>>
Mysql学习总结(77)——温故Mysql数据库开发核心原则与规范
查看>>
Mysql学习总结(78)——MySQL各版本差异整理
查看>>
Mysql学习总结(79)——MySQL常用函数总结
查看>>
Mysql学习总结(7)——MySql索引原理与使用大全
查看>>
Mysql学习总结(80)——统计数据库的总记录数和库中各个表的数据量
查看>>
Mysql学习总结(81)——为什么MySQL不推荐使用uuid或者雪花id作为主键?
查看>>
Mysql学习总结(82)——MySQL逻辑删除与数据库唯一性约束如何解决?
查看>>
Mysql学习总结(83)——常用的几种分布式锁:ZK分布式锁、Redis分布式锁、数据库分布式锁、基于JDK的分布式锁方案对比总结
查看>>
Mysql学习总结(84)—— Mysql的主从复制延迟问题总结
查看>>
Mysql学习总结(85)——开发人员最应该明白的数据库设计原则
查看>>
Mysql学习总结(8)——MySql基本查询、连接查询、子查询、正则表达查询讲解
查看>>