УДК 629.7
Г. Н. Румянцев, С. Л. П у з ы р е в
МИНИМИЗАЦИЯ ВРЕМЕНИ ПРОСТРАНСТВЕННЫХ РАЗВОРОТОВ ДОВОДОЧНОЙ СТУПЕНИ С ДВИГАТЕЛЕМ ГЛУБОКОГО РЕГУЛИРОВАНИЯ
Рассмотрена задача оптимизации управления движением доводочной ступени многоступенчатого летательного аппарата двойного назначения. В качестве направлений решения задачи выделены оптимизация поступательного движения изделия, оптимизация пространственных разворотов и организация движения в направлении поперечных осей. Приведены алгоритмы, реализующие предлагаемые подходы.
Доводочные ступени (ДС) многоступенчатых летательных аппаратов (ЛА) предназначены для выведения в требуемые точки отделения (ТО) полезных нагрузок (ПН). Доводочные системы относятся к так называемым объектам двойного назначения, поскольку предназначены для решения как боевых, так и конверсионных задач [1].
Существующие алгоритмы управления (АУ) движением таких ДС обеспечивают выполнение поставленных перед ними задач с достаточной степенью надежности, однако повышение требований точности и расширение зоны применения подобных изделий выдвигают задачу оптимизации алгоритмов системы управления (СУ).
Под оптимизацией движения изделия будем понимать минимизацию времени разведения ПН по ТО. В данном случае эта задача тождественна задаче минимизации расхода топлива на траектории полета ДС, что может послужить предпосылкой к сокращению гарантийных запасов топлива или увеличению зоны разведения ПН.
Доводочные системы как объект управления. Для описания движения ДС будем использовать инерциальную стартовую систему координат (ИСК) О, п, С и связанную (ССК) с объектом движения систему [2].
На ДС реализована моментная схема управления угловым движением (УД), формирующая управляющий момент (УМ) в виде пары сил. Такая схема обеспечивается четырьмя толкающими и четырьмя тянущими соплами или органами управления (ОУ), установленными неподвижно и позволяющими реализовать поступательное движение изделия в толкающей и тянущей схемах. Схематический вид ДС приведен на рис. 1.
Самостоятельный полет ДС после отделения от носителя проходит на большой высоте в условиях отсутствия атмосферы, в силу чего
Рис. 1. Схематический вид ДС
модель поступательного и вращательного движения ДС заметно упрощается [1, 2]:
mV« = P cos $ cos ф; mVn = P sin $ — g0;
Ix Üx = (Iy — iz )шу Wz +
Iy Üy = (Iz — Ix )wz Wx + MSy
mVz = —P cos $ sin ф; IZüz = (IX — Iy )üxüy + MSZ
¿1 = V«;
n = Vn;
C = Vc;
ф = üx — tg $(üy cos ф — üz sin ф); $ = üy sin ф + üz cos ф;
ф =-й(üy cos ф — üz sin ф);
cos $
(1)
m = m0 \m(r)| dr.
Здесь V, ^, ^ — компоненты скорости центра масс (ЦМ) ДС; Р — сила тяги (СТ) ДУ; т и т0 — текущая и начальная масса ДС; |т(т) | — массовый секундный расход топлива; шХ , <^у ,шZ — проекции вектора абсолютной угловой скорости (УС) ДС на оси ССК; 1Х,1у, ^ — осевые моменты инерции ДС; М^ = Мупрг + Мв^ — сумма управляющего и возмущающего моментов; — углы крена, тангажа и рысканья
(углы Эйлера-Крылова), измеряемые трехосной гиростабилизирован-ной платформой (ГСП).
В качестве ДУ используется твердотопливный двигатель с регулируемой тягой (ТРДУ), обеспечивающий движение ДС в пониженном, промежуточном и маршевом режимах. Использование в ДУ твердого топлива позволяет исключить из модели изделия учет колебаний жидкого топлива в баках.
t
Рис. 2. Траектория ДС на участке движения между двумя ТО ПН
Направления решения задачи оптимизации управления движением ДС. Рассмотрим типичную траекторию движения ДС и характер совершаемых ею маневров. Несмотря на то, что число ПН и длины участков движения могут быть различными, траектория движения от одной ТО ПН до другой, включающая пять участков, является для ДС стандартной и схематично изображена на рис. 2.
В соответствии с приведенной траекторией можно ввести следующие направления оптимизации движения ДС: оптимизация поступательного движения в направлении продольной оси (движение изделия в режиме маршевой тяги на длительных участках), оптимизация пространственных поворотов и применение АУ движением ДС в боковых направлениях. Рассмотрим два последних варианта более подробно.
Оптимизация пространственных поворотов ДС. В СУ нескольких поколений ДС используется так называемая традиционная схема пространственного разворота. Согласно ей, начальное угловое положение ДС описывается текущими углами ГСП ^н перед началом разворота. Конечное положение определяется навигационными углами $к, фк, <^к, соответствующими концу разворота. Основой алгоритма разворота является отработка имеющихся в каналах управления угловых рассогласований (УР)
Дв = вп - вк, в = (2)
между текущими углами ГСП и навигационными углами.
Пусть ктах — уровень ограничения УР на развороте, полученный из соображений высокой динамики разворота при минимальном уровне динамических ошибок. Для каждого канала это значение уменьшается пропорционально величине отношения имеющегося в канале УР и
суммарного УР в трех каналах:
Дв
k
в max
km
ß = V.
(3)
|Д0| + |Дф| + |Др|
Пусть Т0 — время такта бортовой цифровой вычислительной машины (БЦВМ), $п_ь фп-1, <£п_1 — значения углов ГСП на предыдущем такте. Тогда в ИСК сигналы стабилизации запишутся в виде
Öß = min(kemax, ßn - ßj + TAC
ßn ßn—1
ß = 0, ф, V. (4)
Первое слагаемое в выражении (4) характеризует максимальное значение, на которое может выйти УС в каждом канале. Второе слагаемое определяет текущую величину УС.
Далее сигналы 5$, 5ф, 5^ пересчитываются в ССК с помощью следующих соотношений:
5х = Kx (5ф cos + 5V sin cos фп);
5у = Ky (-5ф sin ^n + 5V cos ^n cos фп); (5)
5z = Kz(5$ - 5V sin фп),
определяющих управляющие сигналы автомата угловой стабилизации, где KX, Ky, KZ — коэффициенты усиления.
Рассмотрим теперь усовершенствованный квазиоптимальный ква-тернионный алгоритм (ККА) пространственной переориентации. Согласно Эйлеру любое вращательное движение твердого тела эквивалентно плоскому вращению вокруг некоторой оси. Суть ККА заключается в замене алгоритма пространственного разворота ДС по трем углам плоским разворотом вокруг оси Эйлера. Рассчитаем единичный вектор оси и соответствующий угол поворота.
Известно соотношение для кватерниона Л, соответствующего тройке фн, Vh начальных углов разворота [3]:
Ло\
Ai
Л =
Л2
W
cos
cos
cos
sin
2 2 2 2
cos
sin
cos
cos
фн 2 фн 2
фн 2 фн 2
cos
cos
sin
cos
Vh 2
Vh 2
Vh 2
Vh 2
+ Sin^ — ) Sin О. • (^н
- coS|T
cos
sin
sin
фн 2 фн 2 фн 2
фн 2
sin
sin
cos
sin
Vh 2
Vh 2
Vh 2
(6)
0
Аналогично определяется кватернион N, соответствующий конечным углам Из теории конечного поворота твердого тела известно
соотношение для кватерниона разворота М [3]:
M =
Л. N
(7)
где ||Л| — норма кватерниона, а Л — сопряженный кватернион. Компоненты кватерниона рассчитываются по следующим формулам [3]:
(8)
= Ло^о + + Л2^2 + Аз^з; = Ло^1 - Л^о - Л2^з + Лз^2; ^2 = Ло^2 - Л2^о - Лз^1 + Л1^з; ^з = Ло^з - Лз^о - Л^2 + Л2^1.
Теперь можно определить единичный вектор оси и угол поворота: ( ^ \
I =
V^iT^iT^f + + ^3
X = 2 arccos
(9)
Расчет угловых ускорений (УУ) для ККА. В системе управления ДС с ТРДУ одни и те же органы управления используются в системе стабилизации давления (ССД) ДУ и для управления полетом ДС. При моментном развороте вначале формируются сигналы ССД
ГГОЛК _ ГГОЛК |
°S = 5пр +
5,
ССД ; 2 '
гтян _ гтян
°S = 5пр
5ССД ~2~:
(10)
где сигнал £™лк подается на толкающие, а — на тянущие сопла. Программные сигналы £™лк и выбираются из условия требуемой суммы площадей критических сечений сопел и условия нулевой
продольной силы = 0.
Суммарный сигнал на ОУ формируется в следующем виде:
^ = ¿£лк + й, г = 1,..., 4; = + й, г = 5,..., 8, (11)
где г = 1,..., 8 — командные сигналы (КС) УД ДС.
Рабочий диапазон для всех сопел составляет от -^мп до +^мп импульсов, и сигналы ^ должны располагаться в так называемом свободном диапазоне, т.е. диапазоне, остающемся за вычетом импульсов ¿™лк и Учитывая особенности конструкции ДС, определим сво-
бодные диапазоны для толкающих и тянущих ОУ:
Дтолк = Химп + ¿£ ; Дтян = ^имп ¿£ • (12)
Рассмотрим теперь вычисление максимальных УУ на участках разгона и торможения. При этом зададимся задачей использования максимальных УМ, при которых ОУ находились бы на упоре на обоих участках. Учитывая, что в процессе разворота ось Эйлера сохраняет свое положение, можно получить программные значения ускорений в ССК, используя упрощенные уравнения УД ДС:
толк тян толк толк тян тян
^гпр = ЦХпр + Хпр ) = -(Сг5 ¿г + Сг5 ¿г ), г = Х У ^ (13)
где С™, Столк, г = X, У, £ — эффектив ности в каналах управле н ия относительно осей ОХ, ОУ, для тянущей и толкающей схем.
При выборе коэффициентов усиления в алгоритме стабилизации выполняются следующие соотношения:
СПК""" = СТК™ = К,, г = X, У, (14)
где К, — динамический коэффициент, определяемый из условия обеспечения достаточных запасов устойчивости. Тогда
_^^ толк 1 хтолк
¿толк =-г ^пр , г = X, у, (15)
К,
Для тянущей схемы формулы полностью аналогичны.
По сигналам ¿х, ¿у, ¿^ формируются КС на соответствующие сопла:
¿1 = ¿™лк + ¿уолк - ¿™лк =
(Кхолк/х + Куолк/у - К™лк^ )хпрлк ¿1 хпорлк
¿2 = -¿™лк + ¿У°лк + ¿2™ =
толк толк толк толк толк
(-Кх 1х + 1у + ^);\;пр ¿2Хпр
Kd Kd
¿3 = ¿хлк - ¿у°лк + ¿™лк =
/ Т>"ГОлк7 Т>"ГОлк7 | Т>"ГОлк7 ^'-.ТОлк Г/
(АХ ix - ky ly + ;Хпр ¿зX,
(16)
К, К,
Формулы, описывающие КС полностью аналогичны приведенным
ранее.
Отдельно рассмотрим восемь сигналов $1... $8 и найдем среди них максимальные и минимальные отдельно для толкающих и тянущих сопел. Эти сигналы будут характеризовать те максимально возможные ускорения, при которых по крайней мере один толкающий и один тянущий ОУ будут находиться на упоре, т.е. с полным использованием свободных диапазонов Дтолк и Дтян:
дтолк = хразг
дтян =
разг
Kd Дтол
5'толк "max
Kd Дтян
5' тян 5min
хтолк = хторм
хтян =
торм
Kd Дтол
5'толк 5min
^d ^^тян
(17)
5
тян тах
Суммируя ускорения разгона и торможения для толкающих и тянущих сопел, получим предельные значения ускорений для разворота в моментной схеме:
X
разг
= Kd
Дт
Дт
$'толк тах
$'тян
х
торм
= Kd
Дтолк Дтян
Г'толк $тт
$'тян тах
(18)
Реализация ККА с максимальными УУ разгона и торможения заключается в формировании программы разворота ДС непосредственно в его процессе в соответствии с полученными априорными формулами (18) для предельных УУ. На рис.3 приведена временная диаграмма изменения УУ на развороте.
Участки 1, 3, 5, 7 представляют собой переход ОУ на значения, соответствующие максимальным УУ, и составляют несколько тактов БЦВМ. На участке 2 проводится прогноз программы и угла на этапе торможения. Он заканчивается, когда прогноз показывает, что угол в конце разворота будет близок к заданному. Участок 4 — это разворот с постоянной УС. Разворот произойдет тем быстрее, чем меньше будет длительность этого участка, однако полное его исключение может привести к повышению динамических ошибок. Участок 6 соответствует
Рис. 3. Зависимость углового ускорения от времени на развороте:
1,5 — выход на участки разгона и торможения; 2, 6 — движение с УУ разгона и торможения; 3 — переход на участок движения с постоянной УУ; 4 — движение с постоянной УС; 7 — участок конца торможения
развороту с постоянным УУ торможения и длительностью, рассчитанной на участке прогноза.
Текущие скорость и угол поворота относительно оси Эйлера рассчитываются численным интегрированием
Т Т
Хп = хсп-1 + -^Схп + >¿«-1); Хп = Хп-1 + у (хп + Хп-1). (19)
Согласно уравнению (15) программные КС зависят только от текущего УУ и координат оси Эйлера:
$пр = - Щп, г = х,у,£. (20)
Кл
Необходимым звеном ККА, ввиду разницы истинных и требуемых значений углов из-за упрощений модели УД ДС, является построение автомата угловой стабилизации, обеспечивающего движение ДС вблизи программных значений углов и УС. Для этого в ИСК считаются текущие УС
Аг = вп -/п-1 , в = (21)
То
затем с помощью матрицы перехода они пересчитываются в ССК, и
численным интегрированием определяются текущие углы в ССК:
Т
ат = аГ1-1 г + (шпг + Шп-1 г)у, г = X, У, (22)
Теперь можно получить КС автомата стабилизации, отрабатывающего рассогласования по углам и УС:
$гА° = «т - 1гХп + Тлс(^пг - ¿гХХп), г = X, У, (23)
Суммарные КС запишутся в виде
$г = К($гпр + $лс), г = Х,У,^. (24)
Сравнение работы двух алгоритмов разворотов приведено на рис. 4-6. Видно, что традиционный метод характеризуется большим участком движения с постоянной скоростью и плавным нарастанием УУ, а в случае ККА участок движения с постоянной скоростью минимален, разворот четко разбит на участки разгона и торможения. Характерно и поведение управляющих моментов. В отличие от традиционного алгоритма в случае ККА четко выделяются участки разгона и торможения с резкой перекладкой с одного участка на другой. Все это приводит к сокращению времени переориентации ДС и, как следствие, времени, затрачиваемого на всю траекторию движения.
Сравнительное моделирование показало, что сокращение времени и расхода топлива в результате работы ККА в среднем составило около 10%, что может быть использовано для экономии гарантийных запасов энергетики. Существенный выигрыш во времени переориентации
Рис.4. Изменение угла (1), угловой скорости (2) и углового ускорения (5) на развороте
Рис. 5. Изменение управляющего момента Му на участке разворота
ККА обеспечивает при суммарном УР, большем 100°. Это иллюстрирует рис. 7.
Оптимизация времени работы ДС за счет реализации движения в боковых направлениях. В существующих АУ движением ДС моментная схема используется лишь для реализации квазимоментных разворотов, когда помимо наличия УМ присутствуют также и небольшие по модулю силы Гу и , направленные по осям У и £ ССК. При этом поступательное движение ДС, обусловленное действием этих сил, никак не используется СУ изделием.
Число ограничений, накладываемых при разворотах на уравнения движения ДС, меньше количества независимых переменных, которыми являются СТ ОУ. Поэтому возникает свобода выбора накладываемых на уравнения движения дополнительных условий. Как следствие,
Рис. 6. Изменение угла (1), угловых скорости и ускорения на всей траектории движения ДС
Рис. 7. Зависимость времени традиционного 1 и квазиоптимального 2 разворотов от суммарного углового рассогласования
Y
z
\ А
8
tl
Рис. 8. Проекции управляющих сил и моментов на оси ССК:
1... 8 — номера ОУ
в моментной схеме при одновременной работе всех ОУ появляется возможность реализации поступательного движения в боковых направлениях, приводящего к оптимизации траектории. Например, для близких ТО ПН возможно движение между ТО только за счет боковых сил без изменения ориентации ДС на разворотах, что приводит к сокращению времени движения и затрат топлива.
Рассмотрим организацию бокового поступательного движения для случая нулевой продольной силы. Для простоты рассмотрим симметричную ДС (ут = = 0). Запишем соотношения для проекций управляющих сил и УМ на оси ССК в соответствии с рис. 8:
Fx = kx ТОл(Я1 + R2 + R3 + R4) — кхтян (R5 + Re + R7 + Re); Fy = кутол(—Ri + R2 + R3 — R4) + ky тян (R5 — Re — R7 + Re); Fz = к^тол(—Ri — R2 + R3 + R4) + к^тян (R5 + Re — R7 — Re);
Mx = (kz толГу — кутол rz )(Rl — R2 + R3 — R4) +
+ (кутян^ — kz тянГу )(R5 — Re + R7 — Re);
(25)
My = (kx тол^ — kzтол Гх)( —Rl — R2 + R3 + R4) +
+ ^хтян^ — kzтян Гх )(R5 + Re — R7 — Re);
Mz = (kx толГу — ky тол Гх )(Rl — R2 — R3 + R4) + + ^хтянГу — ky тян Гх)(—R5 + Re + R7 — Re);
где Rl... R8 — СТ восьми ОУ; ту ,rz — плечи сил по осям Y и Z; кхтол, кхтян, кутол, кутян, kzтол, kzтян — коэффициенты, определяющие проекции СТ толкающих и тянущих сопел на оси ССК соответственно.
Найдем теперь максимально возможные силы и Fz. Системы уравнений (26) и (27) представляют собой задачи линейного программирования (ЛП) с целевыми функциями Fу, Fz и рядом условий (сохранение ориентации ДС исключением управляющих моментов и конструктивно обусловленные ограничения СТ ОУ):
Fх = Fz = Мх = Му = Mz = 0Л
У^Дг = R
■о
S;
i=1
R"
0 < R < , i = 1,..., 8;
Fy ^ max;
FX = Fy = MX = MY = MZ = 0; 1
(26)
У^Дг = R";
i=1
r0
0 < Ri < , i = 1,
FZ ^ max.
, 8;
(27)
Рассмотрим задачу (26). Как следует из физического смысла (см. рис. 8) сила Fу будет максимальна при выполнении соотношений:
Rl = ^ = R14; R2 = R3 = R23; R5 = R8 = R58; R6 = R7 = R67.
(28)
В этом случае условия становятся тривиальными и задача ЛП приобретает вид
' kхтол(Rl4 + R23) — kхтян(R58 + R67) = 0; (кх толГу + ку толГх )(Rl4 — R2з) +
+ (кх тян ту + ку тянГх )(R67 — R58) = 0;
R14 + R23 + R58 + R67 = "TT;
RS 2
(29)
R"
0 < R14, R23, R58, R67 < "2"; . 2[^yтол (R23 - R14) + ^Yтян(R58 - R67)] ^ max .
Для частного случая кутол ^ кутян получим следующее решение:
F _ кхтянД;с Л кхтолГу + ky толГх ,
max 7,7 I кУтян 7 , 7 кутол
kXтол + kXтян V kXтянГУ + kYтянгХ
k R0
R— R — П- D_E>_ кХтянЛХ .
R2 — R3 — 0, Ri — R4 —
2(kX тол + kX тян)
r0
R5 _ R8 _ 777-^-Г X
4(кХтол + kx тян)
Л , кХтол Г Y + kY толгХ Y
x I кХтол + kxтян^ ; ; ;
V kx тянГу + ky тянГх/
(30)
r6 _ r7 _ t71-;-7 x
x кХтол k
4( кхтол + kx тян)
kX толГУ + kY толГХ \
Хтол кХтян , , I .
кХтянгУ + кУтян rX /
В случае ненулевой FX решение задачи (26) приобретает вид:
F _ Fx + кхтянД| Л кхтолГу + куТОлГх ,
max 1,1 I кУтян 7 , 7 кУтол
kXтол + kXтян V kXтян + кУтянгХ
FX + кХ тян
R2 _ R3 _ 0; Ri _ R4 _ -----т,
2 (kXтол + kXтян)
R5 _ R8 _
k R0 F + (k R0 + F ) kXтолrY + kYтолГХ (31)
kX™RS - FX + (^тян^ + FX) 1-—j--K 4
_ _kX тян Гу + ky тян rX ,
4 (kxтол + kX тян)
Re _ R7 _
kX толГу + ky тол Tx
kXтол Rs — FX — (kXтянRE + FX)
kxтянГY + ky тянГx
4 (кХтол + кхтян) Подобный подход позволяет получать значения управляющих СТ Л1... и для вариантов движения, не совпадающих с направлением осей У и ^. Так, для расчета максимальной силы, действующей под углом а относительно оси У в положительном направлении отсчета момента Мх, в задаче (26) достаточно поменять второе условие на
Fz ^
условие — = tg а.
Решая задачи (26) и (27) для различных наборов значений , можно получить, что в общем случае зависимость (^у, ^) представляет собой некоторую поверхность в системе координат (X, У, Z), примерный вид которой показан на рис. 9.
Рис.9. Вид зависимости Рх(Ру}Fz) в системе координат (Х,У}Е)
По значениям элементарных СТ рассчитаем КС, подаваемые на ОУ. Сила тяги каждого сопла прямо пропорциональна площади критического сечения:
Дг = Кд Р^, (32)
где Рк — давление в камере сгорания ДУ; Кд — постоянная величина при заданном уровне давления. Площади критического сечения ¿-го сопла в свою очередь, соответствует определенное программное значение КС:
^ = + К^р • ¿прг, (33)
где и — константы, определяемые конструкцией ОУ. В итоге получаем простую формулу связи КС и СТ каждого сопла:
^пр i = j-r
к,
1
Ri
-
(34)
Таким образом, приведенный подход к исследованию возможностей реализации ДС поступательного движения в боковых направлениях позволяет не только оценить максимальные реализуемые изделием величины поперечных боковых сил, но и задавать требуемое движение ДС непосредственным расчетом сил тяги (30), (31) и КС (34) для каждого из органов управления.
СПИСОК ЛИТЕРАТУРЫ
1. Разоренов Г. Н., Бахрамов Э. А., Титов Ю. Ф. Системы управления летательными аппаратами. - М.: Машиностроение, 2003.
2. Арен с В. Д., Федоров С. М., Хитри к М. С., Лучко С. В. Динамика систем управления ракет с бортовыми цифровыми вычислительными машинами. -М.: Машиностроение, 1976.
3. Б р а н е ц В. Н., Шмыглевский И. П. Применение кватернионов в задачах ориентации твердого тела. - М.: Наука, 1973.
Статья поступила в редакцию 3.03.2006