Фильтр Калмана

Оцените состояния дискретного времени или непрерывно-разовой линейной системы

Описание

Используйте блок Kalman Filter, чтобы оценить состояния модели объекта управления пространства состояний, данной процесс и данные о ковариации шума измерения. Модель в пространстве состояний может быть изменяющейся во времени. Установившаяся реализация Фильтра Калмана используется, если модель в пространстве состояний и шумовые ковариационные матрицы все независимы от времени. Изменяющийся во времени Фильтр Калмана используется в противном случае.

Фильтр Калмана предоставляет оптимальное решение следующих непрерывных или дискретных проблем оценки:

Непрерывно-разовая оценка

Учитывая непрерывный объект

$\begin{array}{l} \dot{x} (t) = A (t) x (t) + B (t) u (t) + G (t) w (t) (уравнение состояния) \\ y (t) = C (t) x (t) + D (t) u (t) + H (t) w (t) + v (t) ( уравнение измерения) \end{array}$

с известными входными параметрами u, белый шум процесса w и белый шум измерения удовлетворение v:

$\begin{array}{l} E [w (t)] = E [v (t)] = 0 \\ E [w (t) w^{T} (t)] = Q (t) \\ E [w (t) v^{T} (t)] = N (t) \\ E [v (t) v (^{t) T}] = R (t) \end{array}$

создайте оценку состояния $\hat{x}$ это минимизирует ошибочную ковариацию оценки состояния $P (t) = E [(x - \hat{x}) {(x - \hat{x})}^{T}]$ .

Оптимальным решением является Фильтр Калмана с уравнениями

$\begin{array}{l} L (t) = (P (t) C^{T} (t) + \bar{N}), \\ \dot{P} (t) = A (t) P (t) + P (t) A^{T} (t) + \bar{Q} (t) - L (t) \bar{R} (t) L^{T} (t), \\ \dot{\hat{x}} (t) = A (t) \hat{x} (t) + B (t) u (t) + L (t) (y (t) - C (t) \hat{x} (t) - D (t) u (t)), \end{array}$

где

$\begin{array}{l} \bar{Q} (t) = G (t) Q (t) G^{T} (t), \\ \bar{R} (t) = R (t) + H (t) N (t) + N^{T} (t) H^{T} (t) + H (t) Q (t) H^{T} (t), \\ \bar{N} (t) = G (t) (Q (t) H^{T} (t) + N (t)) . \end{array}$

Фильтр Калмана использует известные входные параметры u и измерения y, чтобы сгенерировать оценки состояния $\hat{x}$ . Если вы хотите, блок может также вывести оценки истинного объекта вывод $\hat{y}$ .

Блок реализует установившийся Фильтр Калмана, когда системные матрицы (A(t), B(t), C(t), D(t), G(t), H(t)) и шумовые ковариационные матрицы (Q(t), R(t), N(t)) являются постоянными (заданный в диалоговом окне Block Parameters). Установившийся Фильтр Калмана использует постоянный матричный P, который минимизирует установившуюся ошибочную ковариацию оценки и решает связанное непрерывно-разовое алгебраическое уравнение Riccati:

$P = \lim_{t \to \infty} E [(x - \hat{x}) {(x - \hat{x})}^{T}] .$

Оценка дискретного времени

Учитывая дискретный объект

$\begin{array}{l} x [n + 1] = A [n] x [n] + B [n] u [n] + G [n] w [n], \\ y [n] = C [n] x [n] + D [n] u [n] + H [n] w [n] + v [n], \end{array}$

с известными входными параметрами u, белый шум процесса w и белый шум измерения удовлетворение v

$\begin{array}{l} E [w [n]] = E [v [n]] = 0, \\ E [w [n] w^{T} [n]] = Q [n], \\ E [v [n] v^{T} [n]] = R [n], \\ E [w [n] v^{T} [n]] = N [n] . \end{array}$

Средство оценки имеет следующее уравнение состояния

$\hat{x} [n + 1 | n] = A [n] \hat{x} [n | n - 1] + B [n] u [n] + L [n] (y [n] - C [n] \hat{x} [n | n - 1] - D [n] u [n]),$

где усиление L[n] вычисляется посредством дискретного уравнения Riccati:

$\begin{array}{l} L [n] = (A [n] P [n] C^{T} [n] + \bar{N} [n]) (^{C [n] P [n] C^{T} [n] + \bar{R} [n]) - 1}, \\ M [n] = P [n] C^{T} [n] (^{C [n] P [n] C^{T} [n] + \bar{R} [n]) - 1}, \\ Z [n] = (I - M [n] C [n]) P [n] (^{I - M [n] C [n]) T} + M [n] \bar{R} [n] M^{T} [n], \\ P [n + 1] = (A [n] - \bar{N} [n] {\bar{R}}^{- 1} [n] C [n]) Z (^{A [n] - \bar{N} [n] {\bar{R}}^{- 1} [n] C [n]) T} + \bar{Q} [n] - N [n] {\bar{R}}^{- 1} [n] N^{T} [n], \end{array}$

где я - единичная матрица соответствующего размера и

$\begin{array}{l} \bar{Q} N = G N Q N G^{T} N, \\ \bar{R} N = R N + H N N N + N^{T} N H^{T} N + H N Q N H^{T} N, \\ \bar{N} N = G N (Q N H^{T} N + N N), \\ и \\ P N = E [(x - \hat{x} [n | n - 1]) (^{x - \hat{x} [n | n - 1]) T}], \\ Z N = E [(x - \hat{x} [n | n]) (^{x - \hat{x} [n | n]) T}], \end{array}$

Установившийся Фильтр Калмана использует постоянный матричный P, который минимизирует установившуюся ошибочную ковариацию оценки и решает связанное дискретное время алгебраическое уравнение Riccati.

Существует два варианта Фильтров Калмана дискретного времени:

Текущее средство оценки генерирует оценки состояния $\hat{x} [n | n]$ использование всего доступного измерения, включая y [n]. Обновления фильтра $\hat{x} [n | n - 1]$ с y [n] и выходные параметры:
$\begin{array}{l} \hat{x} [n | n] = \hat{x} [n | n - 1] + M [n] (y [n] - C [n] \hat{x} [n | n - 1] - D [n] u [n]), \\ \hat{y} [n | n] = C [n] \hat{x} [n | n] + D [n] u [n] . \end{array}$
Задержанное средство оценки генерирует оценки состояния $\hat{x} [n | n - 1]$ использование измерений до y [n –1]. Фильтр выходные параметры $\hat{x} [n | n - 1]$ как задано ранее, наряду с дополнительным выводом $\hat{y} [n | n - 1]$
$\hat{y} [n | n - 1] = C [n] \hat{x} [n | n - 1] + D [n] u [n]$

Текущее средство оценки имеет лучшую точность оценки по сравнению с задержанным средством оценки, которое важно для медленных шагов расчета. Однако это имеет более высокую вычислительную стоимость, делая его тяжелее, чтобы реализовать внутренние циклы управления. А именно, это имеет прямое сквозное соединение. Это приводит к алгебраическому циклу, если Фильтр Калмана используется в обратной связи, которая не содержит задержек (сама обратная связь также имеет прямое сквозное соединение). Алгебраический цикл может повлиять на скорость симуляции. Вы не можете сгенерировать код, если ваша модель содержит алгебраические циклы.

Блок Kalman Filter отличается от команды kalman следующими способами:

При вызове kalman(sys,...) sys включает матрицы H и G. А именно, sys.B имеет [B G], и sys.D имеет [D H]. Когда вы предоставляете переменную LTI блоку Kalman Filter, это не принимает, что обеспеченная переменная LTI содержит G и H. Они являются дополнительными и отдельными.
Команда kalman выходные параметры [yhat;xhat] по умолчанию. Блок только выходные параметры xhat по умолчанию.

Параметры

Следующая таблица обобщает параметры блоков Фильтра Калмана, доступные через диалоговое окно Block Parameter.

Задача	Параметры
Задайте настройки фильтра	Time domain Use the current measurement y[n] to improve xhat[n]
Задайте системную модель	Model source во вкладке Model Parameters
Задайте оценки начального состояния	Source во вкладке Model Parameters
Задайте шумовые характеристики	Во вкладке Model Parameters: Use G and H matrices (default G=I and H=0) Q, Time-invariant Q R, Time-invariant R N, Time-invariant N
Задайте дополнительный импорт	Во вкладке Options: Add input port u Add input port Enable to control measurement updates External reset
Задайте дополнительные выходные порты	Во вкладке Options: Output estimated model output y Output state estimation error covariance Z

Временной интервал

Задайте, оценить ли состояния непрерывно-разового или дискретного времени:

Discrete-Time (Значение по умолчанию) — Блок оценивает состояния дискретного времени
Continuous-Time — Блокируйте оценки непрерывно-разовые состояния
Когда блок Kalman Filter находится в модели с синхронным государственным контролем (см. блок State Control), вы не можете выбрать Continuous-time.

Используйте текущее измерение y [n], чтобы улучшить xhat [n]

Используйте текущий вариант средства оценки Фильтра Калмана дискретного времени. Если не выбранный, задержанное средство оценки (вариант) используется.

Эта опция доступна только, когда Time Domain является Discrete-Time.

Образцовый источник

Задайте, как A, B, C, D матрицы предоставляются блоку. Должно быть одно из следующего:

Dialog: LTI State-Space Variable — Используйте значения, заданные в переменной пространства состояний LTI. Необходимо также задать имя переменной в Variable. Шаг расчета модели должен совпадать с установкой в опции Time domain, т.е. модель должна быть дискретным временем, если Time domain является дискретным временем.
Dialog: Individual A, B, C, D matrices — Задайте значения в следующих параметрах блоков:
- A Задайте матрицу. Это должно быть действительным и квадратным.
- B Задайте матрицу B. Это должно быть действительно и иметь столько же строк сколько матрица. Эта опция доступна только, когда Add input port u выбран во вкладке Options.
- C Задайте матрицу C. Это должно быть действительно и иметь столько же столбцов сколько матрица.
- D Задайте матрицу D. Это должно быть действительно. Это должно иметь столько же строк сколько матрица C и столько же столбцов сколько матрица B. Эта опция доступна только, когда Add input port u выбран во вкладке Options.
External — Задайте A, B, C, D матрицы как входные сигналы к блоку Kalman Filter. Если вы выбираете эту опцию, блок включает дополнительные входные порты A, B, C и D. Необходимо также задать следующее в параметрах блоков:
- Number of states — Количество состояний, которые будут оценены, заданные как положительное целое число. Значение по умолчанию равняется 2.
- Number of inputs — Количество известных входных параметров в модели, заданной как положительное целое число. Значение по умолчанию равняется 2. Эта опция только доступна, когда Add input port u выбран.
- Number of outputs — Количество измеренных выходных параметров в модели, заданной как положительное целое число. Значение по умолчанию равняется 2.

'SampleTime'

Блокируйте шаг расчета, заданный как-1 или положительная скалярная величина.

Эта опция доступна только, когда Time Domain является Discrete Time, и Model Source является Dialog: Individual A, B, C, D matrices или External. Шаг расчета получен из переменной пространства состояний LTI, если Образцовым Источником является Dialog: LTI State-Space Variable.

Значение по умолчанию-1, который подразумевает, что блок наследовал свой шаг расчета на основе контекста блока в модели. Все входные порты блока должны иметь тот же шаг расчета.

Источник

Задайте, как ввести оценки начального состояния и ошибочную ковариацию оценки начального состояния:

Диалоговое окно Задайте значения непосредственно в диалоговом окне. Необходимо также задать следующие параметры:
- Initial states x[0] — Задайте оценку начального состояния как действительный скаляр или вектор. Если вы задаете скаляр, все оценки начального состояния установлены в этот скаляр. Если вы задаете вектор, длина вектора должна соответствовать с количеством состояний в модели.
- State estimation error covariance P[0] (только, когда изменяющийся во времени Фильтр Калмана используется) — Задает ошибочную ковариацию оценки начального состояния P [0] для Фильтра Калмана дискретного времени или P (0) для непрерывно-разового Фильтра Калмана. Должен быть задан как одно из следующего:
  - Действительный неотрицательный скаляр. P является матрицей диагонали нс нс со скаляром на диагоналях. Не уточнено количество состояний в модели.
  - Вектор действительных неотрицательных скаляров. P является матрицей диагонали нс нс с элементами вектора на диагоналях P.
  - Нс нс положительная полуопределенная матрица.
External — Наследуйте значения от входных портов. Блок включает дополнительный входной порт X0. Второй дополнительный P0 входного порта добавляется, когда изменяющийся во времени Фильтр Калмана используется. X0 и P0 должны удовлетворить те же условия, описанные ранее, когда вы задаете их в диалоговом окне.

Используйте Кальмана Гэйна К от образцовой переменной

Задайте, использовать ли предварительно идентифицированного Кальмана Гэйна, содержавшегося в модели объекта управления пространства состояний. Эта опция доступна только когда:

Model Source является Dialog: LTI State-Space Variable, и Variable является идентифицированной моделью в пространстве состояний (idss) с ненулевой матрицей K.
Time Invariant Q, Time Invariant R и опции Time Invariant N выбраны.

Если опция Use G and H matrices (default G=I and H=0) выбрана, Time Invariant G и опции Time Invariant H должны также быть выбраны.

Используйте G и матрицы H (G=I по умолчанию и H=0)

Задайте, использовать ли значения не по умолчанию для G и матриц H. Если вы выбираете эту опцию, необходимо задать:

G Задайте матрицу G. Это должна быть действительная матрица со столькими же строк сколько матрица. Значение по умолчанию равняется 1.
Time-invariant G — Задайте, независима ли матрица G от времени. Если вы отменяете эту опцию, блок включает дополнительный входной порт G.
H Задайте матрицу H. Это должна быть действительная матрица со столькими же строк сколько матрица C и столько же столбцов сколько матрица G. Значение по умолчанию 0.
Time-invariant H — Задайте, независима ли матрица H от времени. Если вы отменяете эту опцию, блок включает дополнительный входной порт G.
Number of process noise inputs — Задайте количество входных параметров шума процесса в модели. Значение по умолчанию равняется 1.
Эта опция доступна только, когда Time-invariant G и Time-invariant H очищены. В противном случае эта информация выведена из G или матрицы H.

Q

Ковариационная матрица шума процесса, заданная как одно из следующего:

Действительный неотрицательный скаляр. Q является СЗ СЗ диагональная матрица со скаляром на диагоналях. СЗ является количеством входных параметров шума процесса в модели.
Вектор действительных неотрицательных скаляров. Q является СЗ СЗ диагональная матрица с элементами вектора на диагоналях Q.
СЗ СЗ положительная полуопределенная матрица.

Независимый от времени Q

Задайте, независима ли матрица Q от времени. Если вы отменяете эту опцию, блок включает дополнительный входной порт Q.

R

Ковариационная матрица шума измерения, заданная как одно из следующего:

Действительная положительная скалярная величина. R является матрицей диагонали ny ny со скаляром на диагоналях. Ny является количеством измеренных выходных параметров в модели.
Вектор действительных положительных скалярных величин. R является матрицей диагонали ny ny с элементами вектора на диагоналях R.
Ny ny положительно-определенная матрица.

Независимый от времени R

Задайте, независима ли матрица R от времени. Если вы отменяете эту опцию, блок включает дополнительный входной порт R.

N

Процесс и перекрестная ковариационная матрица шума измерения. Задайте его как СЗ ny матрица. Матрица [Q N; ^NT R] должен быть положителен определенный.

Независимый от времени N

Задайте, независима ли матрица N от времени. Если вы отменяете эту опцию, блок включает дополнительный входной порт N.

Добавьте входной порт u

Выберите эту опцию, если ваша модель содержит известные входные параметры u(t) или u[k]. Опция выбрана по умолчанию. Отмена выбора этой опции удаляет входной порт u из блока и удаляет B, D и параметры Number of inputs от диалогового окна блока.

Добавьте, что входной порт Включает к обновлениям контрольного измерения

Выберите эту опцию, если вы хотите управлять обновлениями измерения. Блок включает дополнительный импорт Enable. Входной порт Enable берет скалярный сигнал. Эта опция очищена по умолчанию.

По умолчанию блок делает обновления измерения на каждом временном шаге, чтобы улучшить состояние и вывести оценки и $\hat{y}$ на основе измеренных выходных параметров. Обновление измерения пропущено для текущего шага расчета, когда сигнал в порте Enable 0. Конкретно, уравнение для оценок состояния становятся $\dot{\hat{x}} (t) = A (t) \hat{x} (t) + B (t) u (t)$ для непрерывно-разового Фильтра Калмана и $\hat{x} [n + 1 | n] = A [n] \hat{x} [n | n - 1] + B [n] u [n]$ в течение дискретного времени.

Внешний сброс

Опция, чтобы сбросить оцененные состояния и ковариационную матрицу параметра с помощью заданных начальных значений.

Предположим, что вы сбрасываете блок на временном шаге, t. Если блок включен в t, программное обеспечение использует начальные значения параметров, заданные или в диалоговом окне блока или во входных портах P0 и X0, чтобы оценить состояния. Другими словами, в t, блок выполняет обновление времени и если это включено, обновление измерения после сброса. Блок выводит эти обновленные оценки.

Задайте одно из следующего:

None (Значение по умолчанию) — Предполагаемые состояния и ошибочная ковариационная матрица оценки состояния P значения не сбрасываются.
Rising — Инициировал сброс, когда управляющий сигнал повышается с отрицательной величины или нулевого значения к положительному значению. Если начальное значение отрицательно, повышение, чтобы обнулить инициировало сброс.
Falling — Инициировал сброс, когда управляющий сигнал падает от положительного или нулевого значения к отрицательной величине. Если начальное значение положительно, падание на нуль инициировало сброс.
Either — Инициировал сброс, когда управляющий сигнал или повышается или падает.
Level — Инициировал сброс в любом из этих случаев:
- Управляющий сигнал является ненулевым на шаге текущего времени.
- Управляющий сигнал изменяется от ненулевого на предыдущем временном шаге, чтобы обнулить на шаге текущего времени.
Level hold — Триггерный сброс, когда управляющий сигнал является ненулевым на шаге текущего времени.

Когда вы выбираете опцию кроме None, входной порт Reset добавляется к блоку, чтобы обеспечить входной сигнал управления сбросом.

Выведите оцененный выходной y модели

Добавление $\hat{y}$ выходной порт к блоку, чтобы вывести предполагаемые образцовые выходные параметры. Опция очищена по умолчанию.

Ошибочная ковариация оценки состояния вывода P или Z

Добавьте выходной порт P или выходной порт Z к блоку. Матрица Z обеспечивается только, когда Time Domain является Discrete Time, и Use the current measurement y[n] to improve xhat[n] выбран. В противном случае матрица P, как описано в разделе Description ранее, обеспечивается.

Опция очищена по умолчанию.

Порты

Имя порта	Тип порта (В/)	Описание
u (Необязательно)	\in	Известные входные параметры, заданные как действительный скаляр или вектор.
y	\in	Измеренные выходные параметры, заданные как действительный скаляр или вектор.
xhat		Предполагаемые состояния, возвращенные как действительный скаляр или вектор.
yhat (Необязательно)		Предполагаемые выходные параметры, возвращенные как действительный скаляр или вектор.
P или Z (Необязательно)		Ошибочная ковариация оценки состояния, возвращенная как матрица.
(Необязательно)	\in	Матрица, заданная как действительная матрица.
B (Необязательно)	\in	B матрица, заданная как действительная матрица.
C (Необязательно)	\in	C матрица, заданная как действительная матрица.
D (Необязательно)	\in	D матрица, заданная как действительная матрица.
G (Необязательно)	\in	G матрица, заданная как действительная матрица.
H (Необязательно)	\in	H матрица, заданная как действительная матрица.
Q (Необязательно)	\in	Q матрица, заданная как действительный скаляр, вектор или матрица.
R (Необязательно)	\in	R матрица, заданная как действительный скаляр, вектор или матрица.
N (Необязательно)	\in	N матрица, заданная как действительная матрица.
P0 (Необязательно)	\in	P матрица в начальное время, заданное как действительный скаляр, вектор или матрица.
X0 (Необязательно)	\in	Оценки начального состояния, заданные как действительный скаляр или вектор.
Включите (Необязательно)	\in	Управляющий сигнал включить обновления измерения, заданные как действительный скаляр.
Сбросьте (Необязательно)	\in	Управляющий сигнал сбросить оценки состояния, заданные как действительный скаляр.

Поддерживаемые типы данных

Плавающая точка двойной точности
Плавающая точка с одинарной точностью (только для Фильтра Калмана дискретного времени)

Примечание

Все входные порты кроме Enable и Reset должны иметь совпадающий тип данных (один или двойной).
Порты Enable и Reset поддерживают single, double, int8, uint8, int16, uint16, int32, uint32 и булевы типы данных.

Ограничения

Объект и шумовые данные должны удовлетворить:
- (C, A) обнаруживаемый
- $\bar{R} > 0$ и $\bar{Q} - \bar{N} {\bar{R}}^{- 1} {\bar{N}}^{T} \geq 0$
- $(A - \bar{N} {\bar{R}}^{- 1} C, \bar{Q} - \bar{N} {\bar{R}}^{- 1} {\bar{N}}^{T})$ не имеет никакого неконтролируемого режима на мнимой оси (или модульный круг в дискретное время) с обозначением
  $\begin{array}{l} \bar{Q} = G Q G^{T} \\ \bar{R} = R + H N + N^{T} H^{T} + H Q H^{T} \\ \bar{N} = G (Q H^{T} + N) \end{array}$
Непрерывно-разовый Фильтр Калмана не может использоваться в Подсистемах вызова функций или Инициированных Подсистемах.

Ссылки

[1] Франклин, G.F., степень доктора юридических наук Пауэлл и M.L. Рабочий, цифровое управление динамических систем, второго выпуска, Аддисона-Уэсли, 1990.

[2] Льюис, F., оптимальная оценка, John Wiley & Sons, Inc, 1986.

Расширенные возможности

Генерация кода C/C++
Генерация кода C и C++ с помощью Simulink® Coder™.

Генерация кода PLC
Сгенерируйте код Структурированного текста с помощью Simulink® PLC Coder™.

Смотрите также

Функции

extendedKalmanFilter | kalman | kalmd | particleFilter | unscentedKalmanFilter

Блоки

Расширенный фильтр Калмана | Фильтр частиц | Сигма-точечный фильтр Калмана

Документация

Фильтр Калмана

Описание

Параметры

Временной интервал

Используйте текущее измерение y [n], чтобы улучшить xhat [n]

Образцовый источник

'SampleTime'

Источник

Используйте Кальмана Гэйна К от образцовой переменной

Используйте G и матрицы H (G=I по умолчанию и H=0)

Q

Независимый от времени Q

R

Независимый от времени R

N

Независимый от времени N

Добавьте входной порт u

Добавьте, что входной порт Включает к обновлениям контрольного измерения

Внешний сброс

Выведите оцененный выходной y модели

Ошибочная ковариация оценки состояния вывода P или Z

Порты

Поддерживаемые типы данных

Примечание

Ограничения

Ссылки

Расширенные возможности

Генерация кода C/C++
Генерация кода C и C++ с помощью Simulink® Coder™.

Генерация кода PLC
Сгенерируйте код Структурированного текста с помощью Simulink® PLC Coder™.

Смотрите также

Функции

Блоки

Темы

Введенный в R2014b

Документация Control System Toolbox

Поддержка

Документация

Фильтр Калмана

Описание

Параметры

Временной интервал

Используйте текущее измерение y [n], чтобы улучшить xhat [n]

Образцовый источник

'SampleTime'

Источник

Используйте Кальмана Гэйна К от образцовой переменной

Используйте G и матрицы H (G=I по умолчанию и H=0)

Q

Независимый от времени Q

R

Независимый от времени R

N

Независимый от времени N

Добавьте входной порт u

Добавьте, что входной порт Включает к обновлениям контрольного измерения

Внешний сброс

Выведите оцененный выходной y модели

Ошибочная ковариация оценки состояния вывода P или Z

Порты

Поддерживаемые типы данных

Примечание

Ограничения

Ссылки

Расширенные возможности

Генерация кода C/C++ Генерация кода C и C++ с помощью Simulink® Coder™.

Генерация кода PLC Сгенерируйте код Структурированного текста с помощью Simulink® PLC Coder™.

Смотрите также

Функции

Блоки

Темы

Введенный в R2014b

Документация Control System Toolbox

Поддержка

Генерация кода C/C++
Генерация кода C и C++ с помощью Simulink® Coder™.

Генерация кода PLC
Сгенерируйте код Структурированного текста с помощью Simulink® PLC Coder™.