Запишем уравнения фильтра Калмана в общем виде:

где – упрежденная оценка вектора состояние системы по оценке вектора состояния и примененному вектору управления с шага k − 1 на шаг k;

– оценка вектора состояния системы на текущем шаге;

– переходная матрица системы;

– матрица управления системы;

– вектор управляющих воздействий системы;

– априорная ковариационная матрица оценки вектора состояния системы;

– апостериорная ковариационная матрица оценки вектора состояния системы;

– ковариационная матрица шума системы;

– данные измерения;

– матрица наблюдения системы;

– единичная матрица;

– ковариационная матрица шума измерений.

Тогда ковариационные матрицы шумов измерения () и ветрового возмущения () примут вид:

Где = 0.0029 рад/с;

= 0.0029 рад/с;

= 0.0172 рад;

= 0.05 рад;

= ,

= 0.1;

Начальная ковариационная матрица была выбрана экспериментальным путем

Матрица наблюдения БЛА:

Матрицы Ф и B аналогичны матрицам из математической модели объекта.

В результате были получены следующие уравнения для оценки вектора состояния БЛА

Где – измеренная угловая скорость вращения ЛА вокруг оси Ох

– измеренная угловая скорость вращения ЛА вокруг оси Оу

– измеренный угол крена ЛА

– измеренный угол курса ЛА

– угол отклонения элеронов

– угол отклонения рулей направления

– априорные оценки этих параметров на k-м шаге

– апостериорные оценки этих параметров на k-м шаге

– коэффициенты математической модели движения БЛА

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

После установки фильтра Калмана с блоком вычисления угла ветра в боковой канал управления, была получена улучшенная система управления (рис. 1.4.2).

Рис.1.4.2 Боковой канал системы управления с учетом оцененной силы бокового ветра

Страницы: 1 2 3 

Другое по теме:

Железнодорожный транспорт
Выбор транспорта для перевозки груза является порой главным фактором для обеспечения скорости доставки, надежности транспортировки и минимизации затрат клиента. Службы доставки и курьерские службы сегодня предлагают своим клиентам возможность самим выбрать, каким видом транспорта следует ...

Технический ремонт автомобильного стартера
Система запуска двигателя, как следует из названия, предназначена для запуска двигателя автомобиля. Система обеспечивает вращение двигателя со скоростью, при которой происходит его запуск. На современных автомобилях наибольшее распространение получила стартерная система запуска. Систем ...

Разработка производственного корпуса по ремонту грузовых дизельных автомобилей
Автомобильный транспорт играет важнейшую роль в транспортном комплексе страны. Главной задачей автомобильного транспорта является полное, качественное и своевременное удовлетворение потребностей народного хозяйства и населения в перевозках при возможности минимальных затратах материальны ...