【文件属性】:
文件名称:Matlab关于粒子滤波代码与卡尔曼做比较-粒子滤波代码与卡尔曼做比较.rar
文件大小:14KB
文件格式:RAR
更新时间:2022-09-02 07:10:43
matlab
Matlab关于粒子滤波代码与卡尔曼做比较-粒子滤波代码与卡尔曼做比较.rar
部分程序如下:
function ParticleEx1
% Particle filter example, adapted from Gordon, Salmond, and Smith paper.
x = 0.1; % initial state
Q = 1; % process noise covariance
R = 1; % measurement noise covariance
tf = 50; % simulation length
N = 100; % number of particles in the particle filter
xhat = x;
P = 2;
xhatPart = x;
% Initialize the particle filter.
for i = 1 : N
xpart = x sqrt * randn;
end
xArr = [x];
yArr = [x^2 / 20 sqrt * randn];
xhatArr = [x];
PArr = [P];
xhatPartArr = [xhatPart];
close all;
for k = 1 : tf
% System simulation
x = 0.5 * x 25 * x / 8 * cos) sqrt * randn;%状态方程
y = x^2 / 20 sqrt * randn;%观测方程
% Extended Kalman filter
F = 0.5 25 * / ^2;
P = F * P * F' Q;
H = xhat / 10;
K = P * H' * ^;
xhat = 0.5 * xhat 25 * xhat / 8 * cos);%预测
xhat = xhat K * ;%更新
P = * P;
% Particle filter
for i = 1 : N
运行结果:
Figure39.jpg
【文件预览】:
Matlab中文论坛--助努力的人完成毕业设计.url
说明.txt
粒子滤波 目标跟踪 一维情况下 非线性非高斯
----Doc1.doc(28KB)
----ParticleEx1.m(4KB)
使用帮助:新手必看.htm