Разработка алгоритмов контроля и диагностики системы управления ориентацией космического аппарата
При IZGIV*=1 из числа исправных ЧЭ выбираются номера четырех ЧЭ: 3 из них считаются управляющими, а четвертый используется для контроля. Выбор четверки по ПЗ осуществляется аналогично случаю IZGIV*=2.
При IZGIV*=0 выбор работающих измерительных каналов осуществляется аналогично случаю работы на четырех ЧЭ, отличие состоит в том, что контрольный ЧЭ не формируется [21].
Алгоритм ЧЭ формирует запросы на включение ЧЭ IPVG(i)=1 после определения их номеров [21].
В результате формируется управляющая матрица В(3х3), используемая в расчетах проекций приращений углов на приборные оси. Для этого формируется вспомогательная матрица D(3х3), составленная из строк матрицы С(6х3), соответствующих номерам управляющих ЧЭ. Управляющая матрица рассчитывается следующим образом [21]:
B = D-1.
Алгоритм тактированный, работает с тактом То=0,1 с.
3. Алгоритм расчета приращений углов
Алгоритм формирует суммарные признаки функциональной и точностной готовности ГИВУС по признакам, приходящим из подсистемы. Осуществляет выбор диапазона измерений ГИВУС по признаку ППД, формируемому алгоритмами режимов [5 ,21].
Алгоритм формирует
информацию
о приращениях
углов, измеренных
каждым ЧЭ
:
(i=16),
где mi – цена импульса і-го ЧЭ ГИВУС;
Ni – число импульсов с і-го ЧЭ за такт;
i – паспортизуемый уход і-го ЧЭ.
Рассчитываются приращения углов [5, 7] поворота объекта в проекциях на приборные оси ГИВУС gj :
,
где Вjk – элементы матрицы управления;
nuprk – номера управляющих ЧЭ ГИВУС (j=13; k=13).
Затем вычисляются проекции приращений углов на оси визирной системы координат (ВСК) j:



где ADj – погрешности установки ПСК ГИВУС относительно ВСК;
yxj – вычисленный на борту угловой уход (j=13).
Алгоритм тактированный, работает с тактом То=0,1 с.
4. Алгоритм контроля ГИВУС
Контроль осуществляется при условии IZCON=0.
Алгоритм рассчитывает приращение угла по контрольной оси и сравнивается с приращением, полученным с контрольного ЧЭ [21]:
k = Cncon,1g1 + Cncon,2g2 + Cncon,3g3
|k -ncon|<p
где ncon – номер контрольного ЧЭ;
p – порог контроля информации.
Если разность не превышает порог p, заданный в ПЗ, то все включенные ЧЭ считаются исправными. В противном случае для идентификации отказавшего ЧЭ алгоритм формирует заявку на подключение пятого ЧЭ. После достижения им точностной готовности происходит идентификация отказавшего ЧЭ следующим образом: из 5 задействованных ЧЭ формируется 5 групп по 4 ЧЭ в каждой. Для каждой группы вычисляется скалярное рассогласование между показаниями этих ЧЭ. При наличии отказов рассогласование превышает порог p и формируется признак ненормы. Поскольку каждый из 5 включенных ЧЭ входит в 4 группы, то при одном отказавшем ЧЭ ненорма рассогласования возникает в 4-х случаях. Для той группы, куда не вошел отказавший ЧЭ, рассогласование будет в норме [21].
Признаку отказа с номером неисправного ЧЭ присваивается значение 1 и спустя время задержки на формирование признака неисправности, заданное в ПЗ, выдается заявка на его отключение.
Если ненорма рассогласования возникла не в 4-х случаях или ненорма возникла при работе на 4 ЧЭ, когда 2 ЧЭ отказали ранее, то формируется признак ненормы контроля, идущий в телеметрию и никаких решений автономно не принимается.
Алгоритм формирует признак смены работающего комплекта ЧЭ IPSM=1.
При отсутствии точностной готовности прибора, или при количестве отказавших ЧЭ, большем 3, или на время переключения диапазонов, или на время подключения 5-го ЧЭ для идентификации отказа формируется IGIV=0. Иначе прибор считается информативным.
На время отсутствия информативности ГИВУС рассчитывается прогнозируемое приращение угла поворота объекта за такт, которое поступает в алгоритм оценки скорости [21]:
,
где
- оценочная
эффективность
исполнительных
органов;
n – номер такта.
Алгоритм тактированный, работает с тактом То=0,1 с.
Расчет суммарной погрешности
Рассчитаем
суммарную
погрешность
для ЧЭ ГИВУС
1, 3, 5, 6 в виде:
;
(4.16)
где
- погрешность
цены импульса;
- погрешность
случайного
ухода;
- погрешность,
обусловленная
ошибками установки.
Пусть скорость направлена по оси 6-го ЧЭ.
Матрица установки С (6х3) имеет вид:
;
(4.17)
Элементы матрицы С определяются выражениями:
(4.18)
После тригонометрических
преобразований
и предположения,
что
,
выражения
(4.18) будут
иметь вид,
соответственно:
(4.19)
Определим составляющие выражения (4.16).
Вычислим
- погрешность
цены импульса.
Пусть с ГИВУС поступают выходные импульсы Ni (i = 1, 3, 5, 6):
(4.20)
где
– приращение
угла поворота
объекта вокруг
оси чувствительности
i-го
ЧЭ ГИВУС за такт;
– реальная цена
импульсов i-го
ЧЭ ГИВУС;
[…] – операция выделения целой части.
В алгоритме обработки информации ГИВУС приращение угла поворота объекта за такт вычисляется по формуле [7]:
(4.21)
где
- алгоритмическая
цена импульсов
i-го ЧЭ ГИВУС,
взятая из ПЗУ
или ПЗ.
Подставляя
величину
в виде [7, 16, 21,
22]:

где
- ошибка знания
реальной цены
импульсов
ГИВУС, и полагая
в (4.3.5)
в данный момент
времени, из
(4.18) получим
[16]:

где
- ошибка в вычислении
приращения
угла
в алгоритме
обработки
информации
ГИВУС, определяемая
по формуле
[22]:
(4.22)
Контрольную разность можно представить в виде [7]:
(4.23)
Т.к. ошибки
случайны и
независимы
между собой,
получим [21]:
(4.24)
где
- ошибка в вычислении
приращения
угла поворота
в ПСК ГИВУС,
которая вычисляется
по формуле [7,
16, 21]:
(4.25)
где В(j, i) – матрица управления, которая имеет вид:
,
,
.
После подстановки
в (4.25) численных
значений и
некоторых
предположений,
мы получим
значение погрешности
от цены импульса
.
2. Вычислим
- погрешность
случайного
ухода.
В данном случае имеем [7, 21, 22]:
(4.26)
тогда после
подстановки
в (4.24) (4.25)
и с учетом (4.26)
мы получим
значение погрешности
от случайного
ухода
.
3. Приведем методику
вычисления
- погрешности,
обусловленной
ошибками установки
Данная погрешность вычисляется по формуле [7 ,16]:

4.4 Алгоритм стабилизации
В правых частях
динамических
уравнений (1.1)
стоят проекции
вектора главного
момента всех
внешних сил
М, действующих
на корпус
космического
аппарата :
.
Характерной
особенностью
момента управления
является активность,
он появляется
в результате
включения
вспомогательных
органов (в частности
реактивных
двигателей
стабилизации),
и исчезает при
их отключении.
Момент
,
следует логике
теории автоматического
управления,
и обеспечивает
заданное угловое
движение корпуса
космического
аппарата [1, 3].
Источником
внешнего
возмущающего
момента
,
является
взаимодействие
с внешней [1, 4, 6,
10, 12] средой, приводящее
к появлению
действующих
на корпус внешних
сил – гравитационного,
аэродинамического,
светового,
магнитного
и др. Будем
рассматривать
гравитационный
и аэродинамический
моменты. Другие
моменты не
будем рассматривать
в силу их малости.
Момент
имеет две
составляющих
–
(создаваемую
реактивными
двигателями),
и
(создаваемым
моментным
магнитоприводом
и др. Будем
рассматривать
только
).
Важным свойством динамической системы ориентации является: если осями ориентации являются поступательно движущиеся оси, то при соответствующем законе управления вместо сложных пространственных поворотов космического аппарата можно изучать три независимых плоских угловых движения, что мы и сделаем в системе, т.е.:
(4.27)
получено три независимых уравнения.
Пусть двигатели работают в импульсном режиме [1, 4, 6, 11, 12]. Зона нечувствительности определяется условием:
.
(4.28)
Для изучения нужного динамического процесса, коэффициенты k в законе управления (Рис. 4.2):
;
(4.29)
должны быть
положительны.
Сигнал управления
формируется
путем сложения
сигналов датчика
угла и датчика
угловых скоростей.
Включение
двигателей
происходит
при
.
Диаграмма
зависимости
управляющего
момента
от сигнала
имеет вид ( рис
4.3 ) [1 ,3 , 25].

Рис. 4.2 - Закон управления

Рис. 4.3 - Изменение управляющего момента со временем в канале X:
Фазовая диаграмма
процесса установления
ориентации
имеет вид (рис
4.2). Заштрихованная
область – это
комбинация
значений
,
при которых
действует
управляющий
момент [6]. Линии
являются линиями
переключения,
т.е. при пересечении
этих линий
изображающей
точкой происходит
включение (или
выключение)
исполнительных
органов системы
ориентации.
Указанные линии
походят через
точки
на оси абсцисс,
а их наклон
зависит от
коэффициента
k [1, 3, 25]:
;
(4.30)

Рис. 4.4 - Фазовый портрет
Также вводятся
дополнительные
зоны нечувствительности:
,
-
нижняя и верхняя
линии переключения,
располагающиеся
параллельно
оси абсцисс.
Они предназначены
для «гашения»
больших начальных
угловых скоростей
[25]. При пересечении
этих линий
изображающей
точкой происходит
включение (или
выключение)
исполнительных
органов системы
ориентации.
Соответственно
дополнительная
зона нечувствительности
находится между
, и
.
Фазовый портрет
при больших
начальных
угловых скоростях
приведен на
(Рис. 4.5)

Рис. 4.5 - Фазовый портрет с большими начальными угловыми скоростями
Также вводится
гистерезис,
-
предназначенный
для гашения
шумов при
«скольжении»
фазовой диаграммы
по линии переключения
с наклоном
-1/K [3].
Рассмотрим КА как упругое тело [1.3.6.7,9,10,11.12]. Уравнения осцилляторов для упругой модели имеет вид [5]:
(4.31)
где
-
коэффициент
демпфирования
для каждой
отдельно взятой
гармоники.
- квадрат собственной
частоты не
демпфированных
колебаний для
каждой гармоники.
-
управляющий
момент с учетом
возможного
отказа. i
= 1,2,3,4. Коэффициенты


мы берем из
таблицы, приведенной
в Приложении
А.
При нулевой правой части, мы получаем свободные колебания, зависящие от начальных отклонений, угловых скоростей и др. При ненулевой правой части мы получаем вынужденные колебания, которые накладываются на свободные колебания. Они являются затухающими со временем, в силу коэффициента демпфирования. Прототипом для данной упругой модели послужил маятник на пружинке. Рассматриваемая система является линейной.
Находим, также как для абсолютно твердого тела, угловые скорости, угловые ускорения, с учетом возможных отказов [25, 26].
Введем в имитационную модель космического аппарата наряду с двигателями большой тяги – двигатели малой тяги. Будем рассматривать двигатели дросселированной тяги, т.е. реактивные двигатели могут работать как с большой тягой, так и с малой. Введем дополнительную зону нечувствительности для двигателей большой тяги. Для более эффективного гашения шумов введем паузу по времени при выходе из зон нечувствительности. Для наглядности введем паузу Tp = 3 сек. Тогда, фазовый портрет для упругой модели, с учетом работы двигателей малой тяги и действующих на космический аппарат аэродинамического и гравитационного моментов, имеет вид (рис 4.6). Так как задана достаточно большая пауза, то процесс может, получился неустойчивым. Таким образом, очень важным фактором является правильный выбор паузы [25].

Рис. 4.6 - Фазовый портрет для большой паузы
Разработанный алгоритм позволяет моделировать сложные физические процессы с учетом внешних факторов действующих во время полета космического аппарата [1, 3, 25].
4.5 Решение задачи идентификации отказов
Алгоритм обработки данных в бесплатформенной инерциальной навигационной системе строится с использованием субоптимального дискретного фильтра Калмана [7, 16, 22, 25, 27].
Для малых угловых отклонений осей ССК от БСК и при условии Ix Iy Iz уравнения (1.1) и (1.2) запишем в виде [25]:

Тогда для построения системы оценки вектора состояния (j, j, mвj) примем следующую модель объекта наблюдения [16, 22, 27]:
(4.32)
где mj=МДСj /Jj - эффективность управляющего момента;
МДСj - управляющий момент ДС;
mвj=Мвj /Jj - эффективность возмущающего момента;
uj - сигнал управления ДС;
j=x, y, z.
Запишем систему уравнений (4.32) в стандартной векторно-матричной форме, дополнив ее уравнением измерений [7]:

где xj = (x1j, x2j, x3j)T=(j, j, mвj)T - вектор состояния;
zj - вектор измерений;
j - шум измерений;
,
j=x, y, z.
Используя критерий Калмана, несложно показать, что такая система является полностью наблюдаема [7, 16, 22, 25, 26, 27]:
rank[HT ATHT (AT)2HT]=n=3, где n - порядок системы.
Реализация в бортовом вычислителе дискретного фильтра Калмана сводится к оценке вектора состояния по следующим соотношениям [25, 27]:

(4.33)


где:
- оценка вектора
состояния;
- переходная
матрица для
вектора состояния;
- матрица измерений;
- ковариационная
матрица ошибок
фильтрации;
- ковариационная
матрица ошибок
прогноза;
- матричный
коэффициент
усиления;
- ковариационная
матрица шумов
измерения;
j=x, y, z.
Работа алгоритма основана на анализе величины оцениваемого в фильтре Калмана возмущающего момента [25]. Если математическое ожидание оценки возмущающего момента, вычисленного на некоторой временной базе, где управление равно нулю, превосходит допустимый порог, то принимается решение об отказе ДС и переходе на резерв (рис. 4.7) [25].

Рис. 4.7 - Обобщенная структурная схема алгоритма
4.6 Метод статистически гипотез
Статистическая
гипотеза - есть
некоторое
предположение
относительно
свойств [27, 28]
генеральной
совокупности,
из которой
извлекается
выборка. Критерий
статистической
гипотезы – это
правила позволяющие
принять или
отвергнуть
данную гипотезу
на основании
выборки. При
построении
такого правила
используются
определенные
функции результатов
наблюдений
,
называемые
статическими
для проверки
гипотез. Все
возможные
значения подобных
статистик
делятся на две
части: если нет
– гипотеза
принимается,
как не противоречащая
результатам
наблюдения,
если да – гипотеза
отвергается
[27, 28, 29]. При этом
всегда возможно
совершить
ошибку; различные
типы возможных
ошибок заданы
в таблице 4.1:
Таблица 4.1
| Гипотеза | Объективно верна | Объективно неверна |
| Принимается | Правильное решение | Ошибка ll рода |
| Отвергается | Ошибка l рода | Правильное решение |
Вероятность совершить ошибку l рода [8] называется уровнем значимости критерия и обозначается q. Обычно уровень значимости выбирают, равным 0.01; 0.1; 0.05 (последнее значение - наиболее часто) [28].
Критерии значимости – это критерии, с помощью которых проверяют гипотезы об абсолютных значениях параметров или о соотношениях между ними для генеральных совокупностей (с точностью до параметров) функцией распределения вероятностей [29].
Построение
гистограммы
выборки. Гистограмма
является эмпирическим
аналогом функции
плотности
распределения
f(x). Обычно
ее строят следующим
образом:
Находят предварительное количество квантов (интервалов), на которое должна быть разбита ось Ox. Это количество K определяют с помощью оценочной формулы:
K=1+3.2lgN ; (4.34)
Где найденное значение