Запишем уравнения фильтра Калмана в общем виде:
где – упрежденная оценка вектора состояние системы по оценке вектора состояния и примененному вектору управления с шага k − 1 на шаг k;
– оценка вектора состояния системы на текущем шаге;
– переходная матрица системы;
– матрица управления системы;
– вектор управляющих воздействий системы;
– априорная ковариационная матрица оценки вектора состояния системы;
– апостериорная ковариационная матрица оценки вектора состояния системы;
– ковариационная матрица шума системы;
– данные измерения;
– матрица наблюдения системы;
– единичная матрица;
– ковариационная матрица шума измерений.
Тогда ковариационные матрицы шумов измерения () и ветрового возмущения (
) примут вид:
Где = 0.0029 рад/с;
= 0.0029 рад/с;
= 0.0172 рад;
= 0.05 рад;
=
,
= 0.1;
Начальная ковариационная матрица была выбрана экспериментальным путем
Матрица наблюдения БЛА:
Матрицы Ф и B аналогичны матрицам из математической модели объекта.
В результате были получены следующие уравнения для оценки вектора состояния БЛА
Где – измеренная угловая скорость вращения ЛА вокруг оси Ох
– измеренная угловая скорость вращения ЛА вокруг оси Оу
– измеренный угол крена ЛА
– измеренный угол курса ЛА
– угол отклонения элеронов
– угол отклонения рулей направления
– априорные оценки этих параметров на k-м шаге
– апостериорные оценки этих параметров на k-м шаге
– коэффициенты математической модели движения БЛА
– составляющие вектора К, полученного следующим образом:
После установки фильтра Калмана с блоком вычисления угла ветра в боковой канал управления, была получена улучшенная система управления (рис. 1.4.2).
Рис.1.4.2 Боковой канал системы управления с учетом оцененной силы бокового ветра
Другое по теме:
Организация локомотивного депо станции Боготол Красноярского края
Локомотивное хозяйство обеспечивает
перевозочную работу железных дорог тяговыми средствами и содержание этих
средств в соответствии с техническими требованиями. В состав этого хозяйства
входят основные локомотивные депо, специализированные мастерские по ремонту
отдельных узлов локомотиво ...
Шасси машин. Планетарные трансмиссии многоцелевых гусеничных и колесных машин
Планетарными коробками передач (ПКП) называют
многоскоростные (с числом передач две и более) коробки передач, составленные из
планетарных механизмов (ПМ).
Планетарные механизмы (ПМ) – это зубчато-рычажные механизмы,
в которых, в отличие от простых зубчатых механизмов, оси некоторых зуб ...
Разработка технологического процесса восстановления головки блока цилиндров двигателя ЗМЗ-24Д
В процессе эксплуатации
вследствие ряда неизбежных причин (износ, усталостное разрушение, деформация и
др.) работоспособность деталей и узлов автомобиля периодически нарушается,
поэтому возникает объективная потребность в ее восстановлении.
Создание основных деталей
автомобиля требует ...