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

Страница 3

Таким образом, разработка алгоритмов контроля и диагностики системы управления ориентацией космического аппарата – является актуальной задачей.

В настоящей работе решается задача построения алгоритмов контроля и идентификации отказов командных приборов и исполнительных органов.

1 ПОСТАНОВКА ЗАДАЧИ

Возьмем для рассмотрения космический аппарат, как абсолютно твердое тело, не содержащих каких-либо движущих масс [1] (см. рис. 1.1).

Рис. 1.1 - Модель КА

Если триэдр жестко связанных с телом осей Oxyz, с началом координат в центре масс КА (связанная система координат - ССК) направить так, чтобы они совпали с главными центральными осями инерции, то центробежные моменты инерции обратятся в нуль и система уравнений Эйлера [1, 2], описывающая динамику вращения КА вокруг центра масс, примет вид (1.1):

(1.1)

Наряду с динамическими уравнениями рассматриваются кинематические уравнения, связывающие угловые скорости wj с углами поворота триэдра осей Oxyz относительно триэдра осей некоторой базовой системы координат (БСК), начало которой совпадает с началом координат ССК, а оси определенным образом ориентированы в инерциальном пространстве и движутся поступательно [1, 3, 4] . Пусть углы ориентации (углы Эйлера-Крылова) – полностью определяют угловое положение ССК относительно БСК [1, 4]. Понятие углов ориентации [2] становится однозначным лишь после того, как введена последовательность поворотов [3, 4, 5, 6] твердого тела вокруг осей Ox, Oy, Oz. Для последовательности поворотов: система кинематических уравнений имеет вид (1.2):

(1.2)

Системы (1.1) и (1.2) описывают угловое движение твердого тела относительно БСК. Будем предполагать, что углы Эйлера-Крылова jj малы [5]. Текущие значения wj оцениваются в системе по информации измерителя угловой скорости, измеряющего интегралы от проекций вектора абсолютной угловой скорости КА на оси чувствительности прибора. В качестве модели измерителя используется модель ГИВУС [6]. Алгоритм обработки данных в бесплатформенной инерциальной навигационной системе строится с использованием субоптимального дискретного фильтра Калмана [7].

Теперь усложним задачу, рассматривая космический аппарат как упругое тело, что максимально приближает имитационную модель к реальной [1, 8].

Рассмотрим уравнения осцилляторов для упругой модели (1.3):

(1.3)

где - коэффициент демпфирования для каждой отдельно взятой гармоники;

- квадрат собственной частоты недемпфированных колебаний для каждой гармоники;

- управляющий момент с учетом возможного отказа;

i = 1, 2, 3, 4.

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

- разработать алгоритм контроля функционирования двигателей стабилизации, построенный на основе субоптимального фильтра Калмана, позволяющий по информации бесплатформенной инерциальной навигационной системы идентифицировать отказы двигателей стабилизации, в том числе, отказы с неполной тягой при наличии шумов измерений и действии внешних возмущающих воздействий;

- разработать алгоритмы обработки и контроля информации ГИВУС НКА серии «Спектр», состоящие из алгоритма оценки угловой скорости на основе фильтра Льюинбергера и алгоритмы контроля чувствительных элементов ГИВУС с учетом уходов.

2 СИСТЕМЫ УПРАВЛЕНИЯ ОРИЕНТАЦИЕЙ КА НА БАЗЕ БИНС

Управление космическим аппаратом с помощью любой инерциальной системы, в том числе и бесплатформенной, может рассмат­риваться как взаимодействие двух процессов: решения навигаци­онной задачи и решения задачи стабилизации [1, 4]. Первая задача за­ключается в определении требуемой траектории летательного аппарата и в вычислении фактической траектории, вторая — в уп­равлении аппаратом для поддержания требуемого курса с задан­ной точностью [9].

Инерция является наиболее универсальным фактором, позво­ляющим создать приборы для регистрации изменения скорости тел в пространстве. Такие приборы называются акселерометрами или датчиками ускорений. Акселерометр измеряет проекцию на свою ось чувствительности ускорения той точки космического ап­парата, где он установлен. Акселерометр реагирует только на си­лы, прикладываемые через посредство космического аппарата [1, 2]. Если одна из составляющих общей силы, определяющей ускоренное движение аппарата, обусловлена действием тяготения, то соответствующая ей составляющая ускорения не может быть измерена акселерометром. Силы же тяготения действуют одинаково как на прибор, так и на аппарат и поэтому при отсутствии других сил с помощью акселерометра не могут быть обнаружены [1, 3].

Таким образом, при движении космического аппарата в поле тяготения измеряемое акселерометром ускорение отличается от действительного, и поэтому получило название кажущегося ускорения. Измерение кажущегося ускорения позволяет определить истинное положение космического аппарата относительно центра тяготения с помощью интегрирования навигационного уравнения [1, 10]:

где R — вектор положения центра массы аппарата относительно центра тяготения;

ак — вектор кажущегося ускорения центра мас­сы аппарата;

U — вектор-потенциал поля тяготения.

Для управления необходимо знать три ортогональных составляющих вектора ак, т. е. иметь три датчика, установленных в центре массы космического аппарата, с тремя взаимно перпендикулярными осями чувствительности. Эти оси чувствительности должны быть ориентированы по тем осям координат, в которых задан вектор R. Триэдр осей чувствительности акселерометров будем в дальнейшем называть осями измерительной системы [1, 10], а оси, в которых задан вектор R — инерциальным координатным базисом, т. е. базисом, относительно которого отсчитывается абсолютное ускорение. Оси инерции (или оси формы) космического аппарата не совпадают с инерциальным базисом, а вращаются относительно него в зависимости от направления вектора скорости центра масс космического аппарата и угла атаки. Следовательно, для управления с помощью измерения кажущихся ускорений или, как его называют, инерциального управления необходимо либо совмещать оси измерительной системы с инерциальным координатным базисом независимо от движения аппарата, либо в каждый момент времени знать взаимное расположение осей измерительной системы и инерциального базиса. В последнем случае составляющие вектора кажущегося ускорения и оси измерительной системы должны быть перепроектированы на оси инерциального координатного базиса [11].