Модель фильтра Калмана 3 порядка — различия между версиями
Материал из SRNS
Korogodin (обсуждение | вклад) (→Листинг) |
Korogodin (обсуждение | вклад) (→Листинг) |
||
Строка 42: | Строка 42: | ||
C = fix(Tmod/Tc); | C = fix(Tmod/Tc); | ||
− | |||
Xextr = [0; 0; 0]; % Вектор экстраполяций | Xextr = [0; 0; 0]; % Вектор экстраполяций | ||
Строка 59: | Строка 58: | ||
for c = 1:C | for c = 1:C | ||
− | + | Xist = Xextr + K*Ud; % Вектор оценок на c-й интервал | |
− | end | + | Xextr = F*Xist; % Экстраполяция на интервал c+1 |
+ | end | ||
</source> | </source> | ||
Версия 13:04, 20 мая 2011
Модель фильтра Калмана 3 порядка | |
---|---|
Описание | Модель фильтра Калмана 3 порядка на примере ФАП |
Автор(ы) | Korogodin (Korogodinобсуждение) |
Последняя версия | 1.0 (20.05.2011) |
Загрузить | no link |
Хранилище | no link |
Категории | Статистическая радиотехника, Фазовые измерения, Переходные процессы |
Содержание |
Описание модели
Модель фильтра Калмана 3 порядка на примере ФАП
Листинг
Ниже приведен листинг при коэффициентах в установившемся режиме. Следует дополнить уравнения Рикатти для честного соответствия заголовку.
Tmod = 300; % Время моделирования
Tc = 0.005; % Период работы фильтров
C = fix(Tmod/Tc);
Xextr = [0; 0; 0]; % Вектор экстраполяций
F = [1 Tc Tc^2/2;
0 1 Tc;
0 0 1 ]; % Переходная матрица
H = 20; % Hz, полоса
K = nan(3,1); % Вектор-столбец коэффициентов фильтра
K(3) = (1.2*H)^3; % Коэффициенты непрерывной системы в установившемся режиме
K(2) = 2*(K(3))^(2/3);
K(1) = 2*(K(3))^(1/3);
K = K*Tc; % Переход к коэффициентам дискретной системы
for c = 1:C
Xist = Xextr + K*Ud; % Вектор оценок на c-й интервал
Xextr = F*Xist; % Экстраполяция на интервал c+1
end
Tc = 0.005; % Период работы фильтров
C = fix(Tmod/Tc);
Xextr = [0; 0; 0]; % Вектор экстраполяций
F = [1 Tc Tc^2/2;
0 1 Tc;
0 0 1 ]; % Переходная матрица
H = 20; % Hz, полоса
K = nan(3,1); % Вектор-столбец коэффициентов фильтра
K(3) = (1.2*H)^3; % Коэффициенты непрерывной системы в установившемся режиме
K(2) = 2*(K(3))^(2/3);
K(1) = 2*(K(3))^(1/3);
K = K*Tc; % Переход к коэффициентам дискретной системы
for c = 1:C
Xist = Xextr + K*Ud; % Вектор оценок на c-й интервал
Xextr = F*Xist; % Экстраполяция на интервал c+1
end