卡尔曼滤波器的一个最简单的实现
来源:互联网 发布:淘宝助理怎么上传宝贝 编辑:程序博客网 时间:2024/05/17 04:29
卡尔曼是本科毕设期间学习的一个东西,一开始也是云里雾里,最近要做视觉与INS(惯导)的数据融合,需要进行kalman的再一次实现。先将一个最简单的代码实现放上去。供大家参考。没错,是基于MATLAB的,我也想搞个Python的,之前进行视觉导航输出结果计算用的Python,感觉已经爱上不能自拔。
Clear
ts = 1; % Samplingtime
t = [0:ts:200];
T = length(t);
w(1)=0;
w=randn(1,T)
V=randn(1,T);
x(1)=0;
A=eye(1);
for k=2:T;
x(k)=A*x(k-1)+w(k-1);
end
q1=std(w);
Rww=q1.^2;
q2=std(V);
Rvv=q2.^2;
q3=std(x);
Rxx=q3.^2;
c=0.2*eye(1);
Y=c*x+V;
p(1)=0;
s(1)=0;
for t=2:T;
p1(t)=A.^2*p(t-1)+Rww;
b(t)=c*p1(t)/(c.^2*p1(t)+Rvv);
s(t)=A*s(t-1)+b(t)*(Y(t)-A*c*s(t-1));
p(t)=p1(t)-c*b(t)*p1(t);
end
t=1:T;
plot(t,s,'r',t,Y,'g',t,x,'b');
legend(‘估计值’,’测量值’,’真实值’);
阅读全文
0 0
- 卡尔曼滤波器的一个最简单的实现
- 对卡尔曼滤波器的简单了解
- 卡尔曼滤波器的原理
- 卡尔曼简单滤波器
- 卡尔曼滤波器、扩展卡尔曼滤波器、无向卡尔曼滤波器的详细推导
- Opencv中卡尔曼滤波器的使用
- OpenCV 卡尔曼滤波器的使用
- 对Kalman(卡尔曼)滤波器的理解
- OpenCV 卡尔曼滤波器的使用
- 对Kalman(卡尔曼)滤波器的理解
- 对Kalman(卡尔曼)滤波器的理解
- 对Kalman(卡尔曼)滤波器的理解
- 1. 卡尔曼滤波器的介绍
- Kalman(卡尔曼)滤波器的理解
- 对Kalman(卡尔曼)滤波器的理解
- 卡尔曼滤波器的原理及应用
- 卡尔曼滤波器的一种形象表达
- 卡尔曼/扩展卡尔曼滤波器的原理及应用
- VMware 12 安装 macOS Sierra 0.12.4
- Tensorflow 04_: tensorboard或者tensorflow的一个"异常"
- 点击按钮时显示一个弹框,点击空白,弹框隐藏,也可操作弹框中的内容,也可使用弹框中的按钮关闭弹框
- Android Tip: Java代码打印Android堆栈
- freeMarker 中宏<#macro >解析
- 卡尔曼滤波器的一个最简单的实现
- java多线程面试
- 继承笔试题
- apktool 解包和打包问题
- suse server 11 sp2 download
- springMVC与MyBatis中绑定枚举类型数据的转换
- R画直方图
- Android基础控件学习
- MongoDB数据库连接