1 Star 1 Fork 2

18259111695 / kalman_filter

加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
plot_result.asv 1.59 KB
一键复制 编辑 Web IDE 原始数据 按行查看 历史
xiahouzuoxin 提交于 2014-09-25 11:46 . First commit
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% FileName : plot_result.m
% Author : xiahouzuoxin @163.com
% Version : v1.0
% Date : 2014/9/25 9:13:09
% Brief :
%
% Copyright (C) MICL,USTB
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
clear all
clc;
close all;
[fname, fpath] = uigetfile(...
{'*.txt', '*.*'}, ...
'Pick a file');
x = load(fullfile(fpath, fname));
% 按C程序中的打印格式解析
% data = x1;
% data_len = sizeof(x1)/sizeof(float);
% kalman1_init(&state, data[0], 5e2);
% printf("%d %d\n", data, data_len-1);
% for (i=1; i<data_len; i++) {
% printf("%.2f", data[i]); // Original data
% data[i] = kalman1_filter(&state, data[i]);
% printf(" %.2f\n", data[i]); // Filter result
% }
%
% data = x2;
% data_len = sizeof(x2)/sizeof(float);
% printf("%d %d\n", data, data_len-1);
% kalman1_init(&state, data[0], 5e2);
% for (i=1; i<data_len; i++) {
% printf("%.2f", data[i]); // Original data
% data[i] = kalman1_filter(&state, data[i]);
% printf(" %.2f\n", data[i]); // Filter result
% }
x1_start = 2;
x1_end = 1 + x(1,2);
x1 = x(x1_start:x1_end, :);
x2_start = x1_end + 2;
x2 = x(x2_start+1:end, :);
figure,
subplot(211);
H1 = plot(x1(:,1), 'r.');
hold on;
H2 = plot(x1(:,2), 'b-');
hold on;
H3 = plot(x1(:,3), '-', 'Color',[255 0 1]);
legend([H1, H2, H3], '原数据', '一维Kalman Filter', '二维Kalman Filter');
grid on
subplot(212);
H1 = plot(x2(:,1), 'r.');
hold on;
H2 = plot(x2(:,2), 'b-');
hold on;
legend([H1, H2], '原数据', 'Kalman滤波后数据');
grid on
C
1
https://gitee.com/jeffreychan/kalman_filter.git
git@gitee.com:jeffreychan/kalman_filter.git
jeffreychan
kalman_filter
kalman_filter
master

搜索帮助

14c37bed 8189591 565d56ea 8189591