УДК 629.7.05
Синтез закона управления продольным движением космического аппарата в атмосфере Земли при посадке
© Н.Е. Зубов1,2, Е.А. Микрин1,2, В.Н. Рябченко1
1 ОАО «Ракетно-космическая корпорация "Энергия" имени С.П. Королёва», г. Королев Московской области, 141070, Россия 2 МГТУ им. Н.Э. Баумана, Москва, 105005, Россия
Рассматривается задача синтеза в продольном канале закона управления движением космического аппарата в атмосфере Земли при посадке. С применением метода точного размещения полюсов получено аналитическое решение задачи, позволяющее формировать для каждого такта работы бортовой машины стабилизирующее управление.
Ключевые слова: космический аппарат, уровни декомпозиции, метод точного размещения полюсов, аналитическое решение.
Введение. При рассмотрении задачи управления спуском в продольном канале получили распространение упрощенные уравнения движения [1, 2]
= (1)
dX У
& _ 171
dx V X у'
(2)
V 1 - _ с S г
где х = 1п—^ = 1п —, V = е х; у = -*—А1—р, сг, с,, — коэффициенты
V V 2 т\ X х у
лобового сопротивления и подъемной силы, Укр = 7850 м/с2;
г — радиус Земли; g — ускорение силы тяжести; 5 и т — характеристическая площадь и масса космического аппарата (КА); X — логарифмический градиент плотности атмосферы; р — плотность атмосферы. Время полета в атмосфере определяется выражением
X XI
се ах
г = -
г
V«11 у
Управление траекторией полета осуществляется регулированием аэродинамических сил, действующих на КА. При изменении угла крена изменяется эффективная подъемная сила — проекция продольной силы на вертикальную плоскость [1,2]. Соответственно уравнение (1) с учетом сказанного будет иметь вид
У =
d y dx
= ~4Гк—cosy +
c
2 x 1
e -1
y
(3)
Следует заметить, что уравнения (2), (3) являются нелинейными и для построения законов управления применяется линеаризация относительно опорной траектории, полученной при заданном законе изменения cos у. В матрично-векторном виде линеаризованные уравнения (2), (3) запишутся так
d_
dx
V
Г 0
Л 2 x
ду e
д у' = у
д L - Е
V х
1 0 0 0
0 0
Г ду ^
ду' V aL у
0
V 0 у
д и,
или
z = A(x)z + Bu,
(4)
(5),
где u =д u = y[rX мой (4) имеет вид
—cosy
V cx
. Соответственно закон управления систе-
u = knAy + k12ду' + k13aL .
(6)
Все опубликованные ранее работы при выборе коэффициентов k11, k12, k13 основаны на обеспечении устойчивости системы (4), и, соответственно, собственные значения характеристического уравнения системы (4) в процессе движения имеют переменные значения. В силу больших диапазонов изменения величин x, y, а также наличия погрешностей в их определении обеспечить абсолютную устойчивость и заданный запас устойчивости системы (5) на всей траектории снижения довольно трудно.
Данная статья посвящена решению задачи синтеза закона управления (6), обеспечивающего на всем участке полета постоянные заданные значения корней характеристического полинома системы (4), что достигается переменными значениями коэффициентов k11, k12, k13, входящими в (6), и позволяет иметь асимптотическую устойчивость и заданный запас устойчивости.
Размещение полюсов. Задача размещения полюсов или назначения собственных значений (eigenvalue assignment) в линейных динамических системах в той или иной постановке рассматривалась в многочисленных работах, на некоторые из которых ссылаются в [3].
Рассмотрим линейную многомерную динамическую систему
Ях = Лх + Ви, (7)
где ъ е Мп — вектор состояния; и е — вектор входа; М — множество действительных чисел; п > г; Ю — символ, обозначающий либо оператор дифференцирования — Юг(х) = г'(х), либо оператор сдвига — Юг(х) = ъ(х +1).
Предполагается, что матрица В е М "хг имеет полный ранг, а матрица А е Михи заведомо неустойчива, т. е. множество ее собственных значений (спектр)
е1е ( А) = {Xе С : йеХ (XIп - А) = 0},
где 1п — единичная матрица размера пхп, С — множество комплексных чисел (комплексная плоскость), обязательно включает такие Х;. е С, что Яе (Хг-) > 0 для случая Юг(х) = г'(х) и |Хг-| > 1 для случая
Юг(х) = г(х +1). Здесь |Хг| — модуль собственного значения Хг-.
Введем понятие СйаЬ, которое в дальнейшем в зависимости от типа изучаемой М1МО-системы (непрерывной или дискретной) будет обозначать, соответственно, левую полуплоскость С- плоскости С, т. е. Сз1аЬ = С-, либо область внутри круга единичного радиуса с центром в начале С, т. е. СйаЪ = С ^ <1.
Считается, что для системы (7) существует управление с обратной связью вида
и = Кх, (8)
где К е МгХИ — матрица регулятора по состоянию.
Управление системой (7) с помощью законов (8) является классической задачей, когда необходимо найти такую матрицу К, что обеспечиваются некоторые заданные требования к процессу управления, в частности требования на размещение полюсов замкнутой системы (собственных значений матриц А - ВК) в заданных точках Сз1аЬ или в заданной области Сз1аЬ (такой областью, например, может быть вся левая полуплоскость С).
Хорошо известно, что характеристический полином
ёе! (XI„ - А - ВК), (9)
где X = 5 для случая Юг(х) = г'(х) и X = 7 для случая Юг(х) = г(х +1) задают распределение полюсов замкнутой системы на С. Они являются определяющими в отношении устойчивости М1МО-системы.
Накладывая требования на распределение полюсов, можно обеспечить устойчивость и (опосредованно) качество переходных процессов в замкнутой системе.
Требования на распределение полюсов можно задавать с помощью разложения полинома (9) на множители, например,
(Пп - А - ВК) = ()(\Л2 )•••( Л,-£и), (10)
где — заданные значения корней полинома (собственные значения матрицы А + ВК), или разложения матрицы
А - ВК = WЛW-1,
где Л — матрица диагонально-клеточного типа; W — матрица преобразования.
В матрице Л для каждого /-го действительного полюса соответствующего заданному значению корня характеристического полинома, имеется клетка размером 1x1, а для каждой пары комплексно-сопряженных корней — клетка размером 2x2 вида
Re (К)
-Im (К t)
Im ( К)
Re (К )
«2x2
Если заданы кратные корни, то это отражается в структуре матрицы Л, как в ее жордановой форме.
Рассмотрим далее эффективный метод решения задачи полного размещения полюсов [3] М1МО-системы (7), в основе которого лежит декомпозиция матрицы А модели исходной системы.
Пусть В1Т = пи11(Вт) - ортогональная матрица, удовлетворяющая условиям ВХВ = 0(п-г)хг, ВХВ1 = 1п-г. Введем в рассмотрение следующую многоуровневую декомпозицию М1МО-системы (7) [3], представленную парой матриц (А, В), где А е Михи, В е Мпхг.
Нулевой (исходный) уровень
А0 = А, В0 = В, (11)
первый уровень
Ai = Bq A0B01T, Bj = Bq A0B0, (12)
k-й (промежуточный) уровень
A - R1 A R1T
A k — Rk-iAk-iRk-1
L-й (конечный) уровень, L = ceil (n / r) -1,
A k — Rl-iAk-iRl_Ti, Bk = B^-jAk-1-!, (13)
А1 = В ^ А^В^, = В11А1 -1В1-1, (14)
Здесь сеП(*) — операция округления числа * в сторону большего значения, например, сеП(0.1) = 1, сеП(1.6) = 2, сеП(2.01) = 3 и т. д.
Без ограничения общности будем считать, что все матрицы Вг в (12) - (14), являются матрицами полного ранга по столбцам. Согласно [3], если М1МО-система (7) полностью управляемая и матрица К е Мгхт удовлетворяет формулам
К = К 0 = В-А-Ф0В0", В- = КХ + В+, (15)
К1 = В-А1 — Ф1В-, В- = К 2В^ + В++,... (16)
К к = В- Ак -ф к в-, В- = К к X + В+,... (17)
К = В~1А1 -ФВ, (18)
тогда
L+1
eig (A - BK) = U е1в(Ф,.-1). (19)
¡=1
Здесь B+ — псевдообратная матрица Мура — Пенроуза.
Из вышесказанного вытекает следующий алгоритм синтеза регулятора, обеспечивающего заданное размещение полюсов:
1) задать матрицы A0 = A, B0 = B;
2) вычислить L = ceil (n / r) -1;
3) задать матрицы Ф = Ф0, Фь • • •, такие, что
L+1
U ) — желаемый спектр замкнутой системы;
¡=1
4) вычислить ортогональный аннулятор B^ = B1, а затем матрицы
Ai = В0 А0В0 , Bj = В0А0В0 ,•.., Ak = Bk-!Ak-iBi_i, Bk = Bk-iAk-iBk-i;
5) вычислить ортогональный аннулятор Bk , а затем матрицы
Ak+i = Ak BiT, Bk+i = Bi Ak Bk
6) вычислить ортогональный аннулятор В_2, а затем матрицы
AL-1 = BL-2 AL-2BL-2 , BL-1 = BL-2 AL-2BL-2 ;
7) вычислить ортогональный аннулятор Б1_1, а затем матрицы
АЬ = В!-1 А1-1В1Т1, В! = В!-1А!-1В!-1;
8) последовательно вычислить матрицы
KL = BL AL -ФlBL ,
BL-1 - KLBI-1 + B+-1, KL-1 - BL-1AL-1 - ФL-1BL-1 ^ • ^
K k = B-A-ф k B-,...,
K = B- Aj -Ф1В-,
B- - Kk+iBi + B+,
B- — K + B+,
B0 - KjBq + B+,
к - К0 - B0 A0 -фоВ0 .
Управление продольным движением КА в атмосфере. Источником информации о текущих параметрах траектории служат: блок акселерометров, жестко установленный на КА, априорная информация о параметрах номинальной траектории. В этом случае вектор состояния с компонентами Ау, Ау', АЬ будет определяться следующим образом [1]:
n - n
XV)=дn (V) = 4rke~2xду, d(an (V)) = Xyfge-- (ду' — 2ay),
aL = —
t
4rg J
AПх (V)
■dt.
Рассмотрим применение алгоритма синтеза регулятора, обеспечивающего заданное размещение полюсов применительно к задаче нахождения законов стабилизации программной траектории спуска в продольном канале, описываемой моделью (5). В данном случае имеем
f 0 1 0
A = a21 0 0
V a31 0 0
B
V 0 У
(20)
поэтому размерность объекта управления n = 3, вектора управления r = 1, а число уровней декомпозиции для
L = ceil (n / r)-1 = 3 -1 = 2 — три (нулевой, первый и второй).
n
x
t
0
Будем считать, что заданный характеристический полином замкнутой системы (10) имеет вид
3
йе(3 - А - ВК) = (X - ^ )•••(- Х3 ) = П((- ^), (21)
¡=1
где ХгX. заданы исходя из определенных требований.
Согласно введенной многоуровневой декомпозиции нулевой уровень для М1МО-системы с Юг (х) = г'(х) и матрицами (20) имеет вид
В0Х =
А0 = А, В0 = В, М 0 0Л
V 0 0 1У
Во - ВоТ -
М 0Л 0 0
V0 Ь
(22) (23)
Нетрудно убедиться, что для матрицы В0 из (23) выполняется
условие ортогональности.
Первый уровень для системы (5) с матрицами (22), (23) при Юх() = х () выглядит следующим образом:
А - К1 А В1Т -
А1 В0 А0В0 _
' 0 0Л
у-аЪ1 0у
В1 - во Аово -
В+ = В-1
(1 ^ V 0у ' 0 ^
V1 у
а для второго будем иметь
А2 — В ^ — 0, В2 — В ^А 1 В 1, В + — в2 1 —--.
Лъ 1
Зададим матрицы Ф = Ф0, Ф1 и Ф2 в следующем виде:
Фо = Ф1 = 2, Ф2 = 13 ,
(24)
(25)
(26)
(27)
(28)
где Хг — заданные значения корней полинома 3-го порядка.
Выполняя вычисления по формулам (15) - (18) с учетом матриц (22) - (28), получим
2 2 2 2
B - — B + + K 2 B^ — K1 = В-A1 — Ф1В- =
Bo = Bo + K1B0 =
^3 a31 '
X3 ^
a3 1 )
X 2 X3 ^
'3 a31 J
-1 X 2 X 3
a31
К - К о - В0 А0 - ф 0В0 -
a 21 + ^ 2^3 + 2 + ^ 3 ) — ^ 2 — ^ 3
2 ^3
a
31 J
(29)
Матрица-строка (29) определяет закон управления в продольном канале в детерминированной постановке. Поскольку система управления спуском подвержена сильным возмущениям, в том числе и случайным, то применение полученного решения даст существенные ошибки. Для повышения точности рассмотрим задачу идентификации этого возмущения. Будем считать, что в пределах одного такта работы бортовой машины оно постоянно, а значение на начало такта определяется решением задачи идентификации. Модель идентификации (наблюдения) построим на базе уравнения (3), которое при наличии возмущения запишется так:
■ = -V rk —cosy +-+ w (x), (30)
dx cx y
y"= d У
где w(x) — неизвестное возмущение.
Матрицу наблюдаемых параметров С зададим следующим образом:
С = (1 0 0).
Дискретная идентификационная модель будет иметь вид г (п +1) = А0 т (п) + Ви,
где
A D =
1 1 0
a21 1 1 V 001J
, z = (дУ Ay' W).
(31)
Оценка возмущения согласно [4] сводится к рассмотрению вспомогательной системы
п +1) = Л^^(п) + Стп(п), П =
где ц — вектор, имеющий размерность вектора г и полностью управляем вектором п. Поиск матрицы Ь, по сути, и является основной целью решения задачи идентификации с использованием метода, основанного на использовании наблюдателя Люэнбергера.
Применяя к (31) алгоритм (11) - (19), в котором заменяем К на Ь,
А на А^ и В на Ст и для обеспечения максимально быстрой сходимости оценки возмущения назначаем Ф0 = Ф1 = Ф2 = 0, получим
г з о 0л
Ь
-3
-а21 -3 1
о о о о
а оценка возмущения м при отсутствии управления определится как IV ( п +1) = IV ( п ) + Ау ( п +1) - Ау ( п +1). (32)
С учетом (32) и в соответствии с (30) на основании управление вида (8) запишется так:
и = Ац = Кх + м>(п +1),
где матрица К определяется выражением (29).
Заключение. Результаты статистического моделирования в широком диапазоне возможных начальных условий входа в атмосферу показали, что такой подход к решению задачи управления движением КА в атмосфере Земли в продольном канале обеспечивает с вероятностью 0,997 точность приведения в точку раскрытия парашютной системы не хуже 13,5 км.
ЛИТЕРАТУРА
[1] Алексеев К.Б., Бебенин Г.Г., Ярошевский В.Я. Маневрирование космических аппаратов. Москва, Машиностроение, 1970.
[2] Ярошевский В.Я. Вход в атмосферу космических летательных аппаратов. Москва, Наука, 1988.
[3] Зубов Н.Е., Микрин Е.А., Мисриханов М.Ш., Рябченко В.Н. Синтез развязывающих законов стабилизации орбитальной ориентации космического аппарата. Изв. РАН. ТиСУ, 2012, № 1, с. 92-108.
[4] Зубов Н.Е., Микрин Е.А., Рябченко В.Н. и др. Применение метода точного размещения полюсов к решению задач наблюдения и идентификации. Изв. РАН. ТиСУ, 2013, № 1, с. 135-151.
Статья поступила в редакцию 28.06.2013
Ссылку на эту статью просим оформлять следующим образом: Зубов Н.Е., Микрин Е.А., Рябченко В.Н. Синтез закона управления продольным движением космического аппарата в атмосфере Земли при посадке. Инженерный журнал: наука и инновации, 2013, вып. 10. URL: http://engjournal.ru/catalog/it/nav/1081.html
Зубов Николай Евгеньевич — д-р техн. наук, заместитель руководителя по науке научно-технического центра ОАО «РКК "Энергия" имени С.П. Королёва», профессор кафедры «Системы автоматического управления» МГТУ им. Н.Э. Баумана. Автор более 70 работ в области проблем управления космическими аппаратами. e-mail: [email protected]
Микрин Евгений Анатольевич — д-р техн. наук, академик РАН, первый заместитель генерального конструктора ОАО «РКК "Энергия" имени С.П. Королёва», заведующий кафедрой «Системы автоматического управления» МГТУ им. Н.Э. Баумана. Автор более 100 работ в области проблем управления космическими аппаратами.
Рябченко Владимир Николаевич — д-р техн. наук, ведущий научный сотрудник, заместитель научно-технического центра ОАО «РКК "Энергия" имени С.П. Королёва». Автор более 200 работ в области проблем управления космическими аппаратами.