Прогр фильтр Калмана. Комментарии

Обсуждение вопросов, связанных с другими тулбоксами

Модератор: Admin

Vladimir18
Пользователь
Сообщения: 4
Зарегистрирован: Сб июн 16, 2018 6:45 am

Прогр фильтр Калмана. Комментарии

Сообщение Vladimir18 » Сб июн 16, 2018 7:08 am

Здравствуйте! Изучаю фильтр Калмана. Долго искал код программы для среды MatLAB. Нашёл. Добился работы кода. Но мне не всё понятно в этом коде. Если кто-то хорошо умеет моделировать фильтр Калмана в MatLAB, то прошу проставить комментарии в коде (хотя бы главные моменты).

clc;
clear all;
close all;


A = [1.1269 -0.4940 0.1129;
1.0000 0 0;
0 1.0000 0];

B = [-0.3832; 0.5919; 0.5191];

C = [1 0 0];


Plant = ss(A,[B B],C,0,-1,'inputname',{'u' 'w'},'outputname','y');

Q = 1;

R = 1;

[kalmf,L,P,M] = kalman(Plant,Q,R);

M

kalmf = kalmf(1,:);

a = A;
b = [B B 0*B];
c = [C;C];
d = [0 0 0;0 0 1];

P = ss(a,b,c,d,-1,'inputname',{'u' 'w' 'v'},'outputname',{'y' 'yv'});

sys = parallel(P,kalmf,1,1,[],[]);

SimModel = feedback(sys,1,4,2,1);
SimModel = SimModel([1 3],[1 2 3]);

SimModel.InputName

SimModel.OutputName

t = (1:100)';
u = sin(t/5);

n=length(t);

w = sqrt(Q)*randn(length(t),1);
v = sqrt(R)*randn(length(t),1);

[out,x] = lsim(SimModel,[w,v,u]);

y = out(:,1);
ye = out(:,2);
yv = y + v;

subplot(211), plot(t,y,'--',t,ye,'-'),
xlabel('No. of samples'), ylabel('Output')
title('Kalman filter response')
subplot(212), plot(t,y-yv,'-.',t,y-ye,'-'),
xlabel('No. of samples'), ylabel('Error')

barkot
Пользователь
Сообщения: 19
Зарегистрирован: Вс янв 14, 2018 2:28 pm

Re: Прогр фильтр Калмана. Комментарии

Сообщение barkot » Пн июн 18, 2018 10:02 am


Vladimir18
Пользователь
Сообщения: 4
Зарегистрирован: Сб июн 16, 2018 6:45 am

Re: Прогр фильтр Калмана. Комментарии

Сообщение Vladimir18 » Пн июн 18, 2018 11:16 pm

Большое спасибо!
Этот материал я видел.
Программа о которой я писал находится
https://www.mathworks.com/help/control/ref/kalman.html
Там есть, конечно, комментарий и он адекватный коду этой программы. Но мне нужны комментарии, увязанные с текстом научной статьи R.Kalman "A New Approach to Linear Filtering and Prediction Problems". В частности, надо понять на какие уравнения из этой статьи опирался автор кода программы и какой структурной схеме (Fig.) соответствует код программы.

barkot
Пользователь
Сообщения: 19
Зарегистрирован: Вс янв 14, 2018 2:28 pm

Re: Прогр фильтр Калмана. Комментарии

Сообщение barkot » Вт июн 19, 2018 11:47 pm

Vladimir18 писал(а): нужны комментарии, увязанные с текстом научной статьи R.Kalman "A New Approach to Linear Filtering and Prediction Problems".

C этой статьей сложно увязать. Статья с моделью ФК по-проще
http://earchive.tpu.ru/bitstream/11683/ ... p96-97.pdf

Vladimir18
Пользователь
Сообщения: 4
Зарегистрирован: Сб июн 16, 2018 6:45 am

Re: Прогр фильтр Калмана. Комментарии

Сообщение Vladimir18 » Сб июн 23, 2018 4:53 pm

Уважаемые посетители сайта и участники форума, которые просматривают эту тему!
На свои вопросы я отвечу сам. Всё можно увязать! Всё очень просто, но необходимый материал пришлось собирать по частям по большому количеству книг и научных статей. Научные статьи и книги для высшей школы - вот путь к знаниям о том, как грамотно моделировать фильтр Калмана в среде MATLAB. Статьи же случайных авторов-блогеров с поверхностными знаниями - лучше не читать.
Итак, прошу немного подождать и я понятно всё объясню.

barkot
Пользователь
Сообщения: 19
Зарегистрирован: Вс янв 14, 2018 2:28 pm

Re: Прогр фильтр Калмана. Комментарии

Сообщение barkot » Вт авг 21, 2018 11:30 am

Vladimir18 писал(а): прошу немного подождать и я понятно всё объясню.

с интересом ждем продолжения темы ...

LeshaNik
Пользователь
Сообщения: 10
Зарегистрирован: Вт ноя 13, 2012 4:54 pm

Re: Прогр фильтр Калмана. Комментарии

Сообщение LeshaNik » Вт авг 28, 2018 3:49 pm

Владимир, все еще ждем...

AlMich
Пользователь
Сообщения: 39
Зарегистрирован: Пт май 29, 2015 2:16 pm

Re: Прогр фильтр Калмана. Комментарии

Сообщение AlMich » Ср авг 29, 2018 1:50 am


LeshaNik
Пользователь
Сообщения: 10
Зарегистрирован: Вт ноя 13, 2012 4:54 pm

Re: Прогр фильтр Калмана. Комментарии

Сообщение LeshaNik » Чт авг 30, 2018 10:25 am

AlMich писал(а):Вот неплохая книга по теме
https://www.mathworks.com/academia/books/kalman-filtering-theory-and-practice-using-matlab-grewal.html?s_tid=books-seo-redirect
Есть в сети

Спасибо

barkot
Пользователь
Сообщения: 19
Зарегистрирован: Вс янв 14, 2018 2:28 pm

Re: Прогр фильтр Калмана. Комментарии

Сообщение barkot » Пт авг 31, 2018 1:12 pm

Отечественная лит-ра тоже есть
С.С. Ривкин Метод оптимальной фильтрации Калмана и его применение в инерциальных навигационных системах. Изд. "Судостроение", Ленинград, 1973