XXXIV Академические Чтения по Космонавтике им.С.П.Королёва Д.С. Иванов (Московский физико-технический институт) С.О. Карпенко (ИТЦ «СканЭкс») М.Ю. Овчинников (ИПМ им.М.В.Келдыша) Разработка системы определения ориентации МКА на основе фильтра Калмана
Малый спутник Чибис-М Миссия: Исследование физических процессов при атмосферных грозовых разрядах Орбита: Наклонение орбиты, высота орбиты, вес Моменты инерции: Jx= 3.60 кг·м 2 Jy= 3.10 кг·м 2 Jz= 1.50 кг·м 2 Органы управления ориентацией: Маховики Магнитные катушки Датчики определения ориентации: Набор солнечных датчиков Трёхосный магнитометр Трёхосный датчик угловой скорости 2 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Режимы управления и режимы определения ориентации Демпфирование начальной закрутки Разгрузка маховиков Ориентация солнечных батарей на Солнце Стабилизация относительно орбитальной системы координат 33 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва Требуемая точность знания текущей ориентации: ~10 о Локальный алгоритм TRIAD Точность знания текущей ориентации: ~(10 -1 ) о Рекурсивный алгоритм на основе фильтра Калмана
Требования к работе фильтра Калмана 44 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва При известной ошибке задания начального приближения фильтр Калмана должен: сходиться менее, чем за 600 секунд, иметь максимально возможную точность при заданных шумовых характеристиках датчиков ориентации. Вектор измеряемых величин: Вектор параметров ориентации:
Сходимость и точность фильтра График зависимости компонент угловой скорости МКА и оценок компонент угловой скорости от времени. Тонкие линии – истинные значения компонент; Жирные линии – оценка компонент, получаемая с помощью фильтра Калмана. 5 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Фильтр Калмана Основные формулы 66 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Задача Найти начальное значение матрицы ошибок модели движения, исходя из критерия улучшения - скорости сходимости ФК, - точности определения вектора состояния, при заданном начальном приближении углового движения МКА. 77 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Модель движения МКА Принимаем, что на МКА действуют в основном следующие моменты: гравитационный момент; управляющий момент со стороны маховиков; малый случайный возмущающий момент. 8 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Поиск оптимальных начальных условий матрицы ошибок Q Два критерия – скорость сходимости фильтра и точность фильтра. Задача настройки фильра Калмана сводится к поиску по двум параметрам оптимального соотношения: скорость сходимости – ошибка определения вектора состояния. Два способа оценки качества работы фильтра: Численный, Аналитический. 99 Совещание ИПМ - СканЭкс, 26 ноября 2009 г.
Численное исследование фильтра на основе трёх датчиков Магнитометр: погрешность измерений (3 сигма) : 250 нТл Солнечный датчик: погрешность определения направления на Солнце (3 сигма): ± 0.1 Датчик угловой скорости: чувствительность : °/сек Время сходимости при трёх датчиках Ошибка определения по трём датчикам 10
Результаты поиска Состав приборов Значен ие, град Значени е, град/c Время сходим ости, с Точность определе ния угла град Точность определени я угловой скороти, град/c М+СД+ДУС255 М+СД315 Пример значений параметров настройки фильтра Калмана для достижения наивысшей точности оценки вектора состояния МКА 11 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Сопутствующие задачи определения ориентации Разработка алгоритмов на основе фильтра Калмана в случае выхода из строя одного из датчиков. Оценка наведённых магнитных полей, создаваемых приборами на борту МКА. Калибровка датчиков определения ориентации на борту МКА. Отслеживание аномальных измерений, которые могут быть связаны с выходом датчика из строя или сбоем при передачи информации. 12 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Точность определения наводимых полей Ошибка определения в зависимости от параметра фильтра Влияние неточности знания наводимых полей на точность определения ориентации 13 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Правило 3-х сигм Для нормально-распределённой величины справедливо с вероятностью Прогноз невязки измерений равен: Ковариационная матрица ошибок измерений Вектор измерений аномальный, если 14 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Пример отбраковки График зависимости ошибки измерений от времени по одной компоненте магнитометра 15 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Оценка параметров с удалением аномальных измерений Оценка векторной части кватерниона без отброса аномальных измерений Оценка векторной части кватерниона с отбросом аномальных измерений 16 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Заключение Проведено исследование алгоритмов определения ориентации с использованием измерений магнитометра и солнечного датчика, магнитометра, солнечного датчика и датчика угловой скорости. Проведено исследование алгоритма оценки наводимых на борту магнитных полей. Реализован алгоритм идентификации аномальных измерений. 17 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва
Спасибо за внимание 18 XXXIV Академические Чтения по Космонавтике им.С.П.Королёва