2019
ВЕСТНИК ПЕРМСКОГО УНИВЕРСИТЕТА
Математика. Механика. Информатика
Вып. 3(46)
УДК 519.7
Коррекция полета тяжелой материальной точки в среде с сопротивлением при наличии геометрических ограничений на дополнительные управления
С. В. Лутманов, О. А. Хотько
Пермский государственный национальный исследовательский университет Россия, 614990, г. Пермь, ул. Букирева, 15 mpu@psu.ru; (342)239-63-09
Данная работа является продолжением цикла статей [5-7], посвященных коррекции возмущенного полета управляемой тяжелой материальной точки с целью выхода ее на базовый закон движения. Возмущение полета вызвано неточным соблюдением начальных условий, а коррекция движения производится дополнительными управлениями, входящими в дифференциальные уравнения движения аддитивно базовым управлениям. В отличие от работ [5-6] здесь считается, что на параметры дополнительного управления наложены геометрические ограничения в форме включения в некоторое выпуклое компактное множество. Показано, что если геометрические ограничения не слишком обременительны, то коррекция движения может быть успешно осуществлена.
Ключевые слова: базовое движение; возмущенное движение; программное управление; коррекция полета; критерий качества.
DOI: 10.17072/1993-0550-2019-3-56-64
1. Уравнения движения управляемой точки и требования к кинематике полета
В работе [5] были выведены дифференциальные уравнения управляемого полета тяжелой материальной точки в однородном поле тяжести в среде с сопротивлением, пропорциональным квадрату скорости (см. рис. 1).
2
_ V
Г
у
х
/
Рис. 1
© Лутманов С. В., Хотько О. А., 2019
Эти уравнения имеют вид
гх = -к(х
тх = -к[х2 + у2 + ¿2) •
I
х~ + у1 + г2
ту = -к + V + 2 ) • У
х 2 + у 2 + 2 2
тг = -к[х2 + у1 +г2)-
пщ + у\,
у/х2 + у2 + 22
или
к .
V. о .о .о
X" + у" Н--
т " т
1
к
к
V. 2 '2 -2
Х-+у-+2~ +— V,,
т т
V•2 *2 -2 1
х + у + г - g + — V3,
т т
1
(1.1)
где z — вертикальная, x, y — горизонтальные, координаты точки, m — ее масса, g — ускорение силы тяжести, k = const — коэффици-
ент пропорциональности, а
вектор
V V3 J
управляющих параметров. К кинематике полета предъявляются следующие требования. Движение начинается в момент времени и заканчивается в момент времени Т > на поверхности земли в положении, близком к точке (хт, ут, гт ). При этом полет должен
происходить на высоте не менее 8 > 0 (за исключением заключительной фазы полета) и не более 28 > 0 от поверхности земли. Начальное положение и начальные скорости точки заранее не определены. Про них лишь известно, что они удовлетворяют условиям
хо * о> Уо * [р( Х0'Уо) + 8,^( хо> Уо ) + 28]^
z0 G
T-t,
-,Уо
Ут T-L
T-U
где р: Я2 ^ Я1 — гладкая функция двух переменных, моделирующая рельеф местности. Точные значения начальных условий х0, у0, г0, х0,у0, ¿0 становятся известными
только в момент старта. Управление движением точки будем осуществлять в классе программных стратегий.
Определение 1. Произвольная интегрируемая вектор-функция V: [го, ТЯ3, называется программным управлением точкой на промежутке времени [?0, Т ].
В статье решается следующая задача управления полетом точки.
Задача. Построить программное управление V0: ['0, ТЯ3 материальной точкой,
которое обеспечивало бы выполнение требований, предъявляемых к кинематике полета.
2. Базовый кинематический закон движения точки и базовое программное управление
Введем понятие базового закона движения точки.
Определение 2. Кинематический закон движения точки
x = X(t), y = y (t), z = Z(t) t e[to,T]. будем называть базовым законом движения,
если
X (to ) = 0 y (to ) = 0 z (t0 )G[(( Xo,yo) + Z,v( Xo, Уо ) +
Ут
1 'о 1 'о
и он удовлетворяет всем требованиям, предъявляемым к кинематике полета.
Приведем один способ построения базового закона движения точки. Полагаем
*о = <и = о, К =
1 'о 1 'о
Пусть ^ е('0, Т) и 5 — натуральное
число.
Разобьем промежуток времени [t0, T ]
точками
т0 =t0,Tx =T0+A,--,TS = т,_г+А = Т,
T — t А = T—0.
Не теряя общности, считаем, что для некоторого номера 5С < 5 выполняется равенство
= ' . В противном случае разбиение промежутка времени [?0, Т ] можно сделать частично неравномерным.
Далее нарабатывается массив точек
где
Zo G[((X(Т0),y(Т0)) + 8, (( X (Т0 ) , y (Т0 )) + 2s], z1 G[p(X (Т1), У (Т1 )) + s, р(X (Т1), y (Т1)) + 2s
z„ G
р
[((X ) , y )) + ^, (X (^sc ) , y ^ )) + 2^] ,
X
1
X
0
s
2 с+1 е
р(* (Я +1 ) , У +1 ))
р( * (я+1) , У (т +1)) + 2е
Т-т
Т-т
р(* (Тс-1 ) , У (Тс-1 )) + -
Т-т
Т-т
Т -т
р(* (Тс-1 ) , У (Тс-1 ))+ 2е с-1
Т -т
2с = 2Т •
Функциональная зависимость
2(г) = /(г), ге[г0,Т]
устанавливается путем интерполяции массива точек. В результате получим
п
/ (г ) = ! а/ •
¿=0
Выбирая число промежутков с достаточно большим, а степень интерполяционного полинома достаточно высокой, можно добиться того, что кинематический закон движения точки
* = * (г), у = у (г), 2 = 2 (г),
г е[го, Т ] (2.2)
будет базовым.
Определение 3. Программное управление
V = V(г), г е[го,Т],
реализующее базовый закон движения точки, назовем базовым программным управлением.
Для построения базового программного управления уравнения (1.1) разрешаем относительно управлений:
V = т* + к* •у/*2 + у2 + 22,
г2 = ту + ку ■ ^х2 + у2 + ¿2,
гу + ку■ -фс г'2 + к2 •
(2.2)
:,2 , -2 , -2
V = т2 + к2 •*/* + у + 2 + mg.
Базовый закон движения (2.1) подставим в уравнения (2.2). В результате получаем искомые базовые управления
(7) = шх(7) + +к* (г) •у] *2 (г) + у2 (г) + 22 (г), у2(1) = ту(1) +
+ку (г *2 (г) + у2 (г) + 22 (г),
(7) = т£(г) +
+к2 (г *2 (г) + у2 (г) + 22 (г) + mg.
3. Возмущенные начальные условия и возмущенные движения
Пусть
Л
Л
voz 0 уVог 0
V ^402 0 J
0 у 0
V 20 J
+
^0 ^20 J
3у0
VSzо J
* 0,
(х ^
Ууог 0 = Я*о) + ?
\2уог0 У Я'о);
где величины ¿У0 ,
1^20 J U2oJ
малы.
Определение 4. Вектора
Л
\
voz 0
УV02 0
V 2 уюг 0 J
л
Л
0
УУ02 0
V 2 402 0 У
назовем возмущенными начальными условия-(8хЛ (8хЛ
ми, а вектора
$У0
\520 J
* 0,
¿Уо
Ч^о У
Ф 0 - возму-
щением начальных условий точки. Обозначим
* = (г) , У = Ум (г) , 2 = 2«,г (г) ,
г е[г0, Т ] (3.1)
- решение системы дифференциальных урав-
нений
* = - • 2 + у2 + 22 + — V (г),
т т
у = --у ^ *2 + у2 + 22 +—V2 (г),
т т
2 = -к2•у]*2 + у2 + 22 -g + — V (г),
к_
т " да
с начальными условиями
* (г0 ) = 0 , У (г0 ) = У™0 , 2 (г0 ) = х(*о) = Х**О,У('О)= У™о> 2(*0) = 2
V02 0 '
2с-1 е
Определение 5. Кинематический закон движения точки (3.1) назовем возмущенным движением, а разность
Г
8х (г (ху0г (г Г ( х (г л
8у (г) = Ууог (г ) - у (г)
6г (г), V ^ (г)у ш
¿¿(Ур 'МО' ГДО]
¿НО = У™ (0 - но
3Н0) /«ДО, но V 4 V
г е[;0,Т]
возмущением движения точки.
4. Минимизация возмущений
Основная идея решения задачи управления точкой, сформулированной в первом пункте, состоит в построении управления, вынуждающего точку двигаться по кинематическому закону, который, начиная с момента времени г1 е [г0, Т], мало отличается от базового закона движения. Для этого требуется обнулить возмущения в момент времени
'1 е[^о, Т ].
Обнуление возмущений будем осуществлять при помощи дополнительного управления
(
и
() =
и1 О
Л
и
()
Vиз О,
которое вводится в дифференциальные уравнения (1.1) аддитивно основному управлению, т. е.
к
х =--X
т
х2 + у2 + ¿2 +-
У =
т к
-(Щ + щ),
ух2 + у2 + г2 + - ( у2 (г) + и2), т
х2 + У2 + г2 -8 +—(Уз(г)+из).
г =--г "Лх2 + у2 + г2 - 8 + —
т т
Динамика управления возмущениями приближенно описывается векторным линейным дифференциальным уравнением [5]:
х = + ,
(4.1)
(0 0 0 1 0 0 0 0 0 0 0 0
Л (г ) =
0 1 0
0 ^ 0 1
0 0 0 ^ ^ ^
дх ду дг
дх ду дг
дх ду дт.
у=К')
V, =У,(г), 1=1,2,3
5 (г ) =
(0 0 0 > ( 91 ]
0 0 0 92
0 0 0 9з
0 0 , 9 =
т 94
0 1 т 0 95
V 0 0 х т у V 9бу
\ к ■ 1-2 , • 2
*>у1 ) = -- хх + у
т
е Я6
+ — У1 т
^2 (х, у, г, У2 ) =--у х2 + у2 + г2 +
т
+ — У2 т
Р* ( х, у, г, Уз ) = - — г х2 + у2 + г2 -т
- 8 + — Уз. т
При отсутствии геометрических ограничений на дополнительное управление для начального возмущения
( ^х0 ^ 5г(,
9 (г0 ) =
5х0
5Уо
\5*0 J
где
в работах [5-6] задача обнуления фазового вектора линейного объекта (4.1) в момент
времени г1 е [г0, Т ] была решена.
1
1
При этом разрешающее управление в работе [5] было оптимально по критерию "минимум энергии", а в работе [6] - по критерию "минимум силы". Терминология взята из монографии [1].
В данной статье принимается, что
u е P, где P ^ R3 — выпуклое компактное множество. Символом Пр [t0, ^ ] обозначим множество всех программных управлений на промежутке времени [t0, t ], для которых выполнено включение u (t) е P, t е [t0, t ]. В силу геометрических ограничений на управление u (•) задача обнуления фазового вектора системы (4.1) в момент времени t е [t0, T]
может и не иметь решения. Вместо нее здесь решается задача минимизации расстояния от фазового вектора в момент времени t до
начала координат.
Указанное минимальное расстояние £° (t0, % ) вычисляется по формуле [2]
(^ Чо) = max {o, max [(Q [t1, t0 ] x0, /)],
ti
Jmin(H [t]u, /)dr\-, (4.2)
+
где Q [г, т], г, т е [г0, г1 ] - фундаментальная матрица Коши для однородного уравнения д = А^)д, а = &
матрица перехода для линейного объекта (4.1). Заметим, что если е0 (г0, ) > 0 , то обнулить возмущения в момент времени г1
нельзя в принципе.
Алгоритм решения задачи минимизации основывается на следующих двух утверждениях [1-2].
Теорема 1. Пусть е0 (г0, д0 )> 0 .
Тогда максимум в (4.2) существует и достигается на единственном векторе
10 е Я\\\1 °|| = 1.
Символом q (•, г0, q0, и (•)) обозначим движение линейного объекта (4.1), выходящее из начального положения (г0, q0 ) и порожденное управлением и (•) е [г0, г1 ].
Теорема 2. Пусть е0 (г0, q0 )> 0 и
и0 (•) е Пр [г0, г ] - программное управление, для которого выполнено условие
^ (гl, го, qо, и 0 (•)| = е° (го, qо )>0.
Тогда
(н [г ] и0 (г), I °) = шш( Н [г ] и, I
г е[^ г1 ].
Изложим алгоритм построения программного управления и0 , г1 ], решающего задачу минимизации расстояния от фазового вектора линейного объекта до нача-координат в случае, когда е0 (г0, ^) > 0 и
ла
P = ^
fu^
V u3 J
u | - a, u - a, u - a
1. Вычисляется величина
lfK (t) Кг (t) hi3 (t
H [t] u, Л =
к (О МО МО
h61 (t) h62 (t) h63 (t)
fu^
KU3J
(/ л /1
V /6 J
f 3 ^
Z hu(t) uj
j=1
(/ л /1
Z h6j (t)(t)u
V j= 6 ( 3
= Z Z hj(t) uj
'= V j= j
^ 6 Л 3
V /6 J
/ =
где
=ZIZh(t)/ u =Z^j/)u,
j=1 V ¿=1 J j=i
6
^ (t,/) = Zhj (t)/, j = 1,2,3 .
i=1
2. Решается задача математического программирования
3
H[г]и, 0 = Z®y (t,l)U ^ min,
j=i
и e P.
U (t, l
4. Строится оптимальное управление
U (t, l° ^
U ° (t ) = U0 (t, l° ):
U0 (t, l0) U0 (t, l°)
Пусть U° (t, l) =
U2° (t, l) U° (t, l)
решение
этой задачи. Тогда
t e[t°, ti ] (4.3)
5. Производится проверка. Интегрируется дифференциальное уравнение
d-q(t) = A(t)q(t) + B(t)и° (t),
dt
- a
U° (t, l) =
-a.
®y( t, l )> °,
Уe[-aj, aj ], j ^l ) = °,
t, l )< °. • sigw [^.(t, l)], j = 1,2,3 .
t e [t°, ti ]
4. Вычисляется величина
H [г]u0 (t, l), Л = £>,(t, l)u° (t, l) =
j=i
-Z a Ы t,l ^.
j=1
3. Решается задача математического программирования
Q[ti, t°]q°, l) + {(H [r]U0 (г,/), l)dr =
Q ^^ t° ] q°, 0 - f Z ai \®j (г, l)dr ^ mаx,
t°j=i
6
Zl2 = i.
i=i
li
Пусть l0 =
V 4У
ее решение.
Заметим, что
8°(t°, q° ) = (Q [ti, t° ] q°, l
г =
+J( H [r]U0 (г, l °), l ° )di
t°
ti 3
Q [ti, t° ] q°, l °)-fZ aj |©j (г, l0) dr .
с начальными условиями q (t0) = q0 . Обозна-q0 (•) = q (•, t0, q0, и0 (•)). Должно выпол-
чим няться
(t°, q° M q0 (ti), {°}) = | |q0 (ti )||.
5. Решение основной задачи управления
Полагаем
°
v° (t) ^ (t)
v° (t)
V 3 V )j
'Vi (t)+u° (t
V2 (t) + U°° (t)
V (t) + и 0 (t)
' Vi (t V2 (t)
(t).
t e [^ ti ]
t e (ti,T]
(5.1)
V 3v;у
Обозначим
Xkor (t) , Уког (t) , Zkor (t) , t e[t°, T ]- решение
системы дифференциальных уравнений
1
k_ т k .
х =--x-Jx2 +у2 +z2 + —V0(i),
m m
y =--y ^ X2 + y2 + z2 + — v0 (t),
m m
k
z =--Z • JX2 + y2 + Z2 - g + — v0 (t),
m m
1
с начальными условиями
X (t° ) = Xvoz ° , y (t° ) = yvoz ° , Z (t° ) = X (*0 ) = XvOZ0 > У (t0 ) = Л»0 = Z
'voz° •
voz 0 '
Определение 6. Закон движения *ког (•), Уш (•), 2kor (•) называется откорректированным законом движения точки.
Откорректированный закон движения динамического объекта приближается к базовому закону движения в момент времени г е[г0, Т] на расстояние е0 (г0, ^ ) . В случае,
когда эта величина мала, дальнейший полет точки будет происходить в малой окрестности базового закона движения. Таким образом, требования к кинематике полета будут вы-
полнены, и управление
(•)
будет решени-
ем задачи, поставленной в пункте 1.
6. Численный эксперимент
Изложенная выше теория иллюстрируется на следующих числовых данных:
к = 0.45, m = 100кг, g = 9.8
м
s = 30 м,
сек
t0 = 0, T = 10сек, р (х, y) =50 • sin (0.00005 • x • y) м, x0 = -40 м, y0 = 20 м, z0 = 40 м, , xT = 3000 м, yT = 100 м, zr = р(xT, ут ) = 32.51 м,
х(1 = 310 —,у„ =-Ю — ,z„ =-12.75 — , сек сек сек
s = 100, t* = 5 сек ^ sc = 50, n = 15, a = 2050 н, а2 = 2050 н, а3 = 2050 н . Здесь s0 (t0, p0) = 0.38 м > 0 и, следовательно, задача обнуления возмущений не разрешима. Этот факт подтверждается и путем вычисления величин
0 (t )|,
u = max \u
энерг г i энерг
íe[t0,í1 ]'
0 0 u = max u
сил г ' сил г
te[ÍQ,Í1 ]'
(t)|, i = 1,2,3,
На рис. 2-4 приведены покомпонентные
графики управления и0 (•) , вычисленного по
формулам (4.3). На них мелким пунктиром нарисован график компоненты управления, а крупным - граница области ее изменения.
где и Энер (•), и и (•)- оптимальные управления, решающие задачу обнуления возмущений, полученные в работах [5], [6] соответственно. Имеют место неравенства и1ер 1 = 2293,7 н > 2050 н,
и\= 2172,1н > 2050 н (/ = 1, j = 1),
сил1 ' V ' ^ ' '
которые означают нарушение геометрических ограничений и е Р для управлений
иэнер (•) , исил (•) .
Рис. 2. Первая компонента управления
Рис. 3. Вторая компонента управления
Рис. 4. Третья компонента управления
Таким образом, управление и0 (•) удовлетворяет включению и0 (г )е Р, г е[го, г1 ] и
представляет собой кусочно-постоянную функцию, принимающую значения на границе своей области изменения. Непосредственно убеждаемся, что
||р (^ ^ ^u 0 (•))
= 0.4 м:
0.38м = s0 (t0,p0) .
Следовательно, управление и0 (•) действительно решает задачу минимизации расстояния от фазового вектора линейного объекта в момент времени ^ = 5 сек до начала координат. Величина е0 (г0,р0) = 0.з8м мала по
отношению к величине дальности полета, поэтому управление, решающее задачу для исходного нелинейного объекта, можно построить по формуле (5.1).
На рис 5. приведены совместные графики координаты г = г—ог (г), г е [г0, Т] точки в
движении по откорректированной траектории (тонкая линия) и рельефа местности
г = ф(хо (г), у—ог (г)), г е [г0,Т] (жирная линия).
Z, м
Рис. 5
Из рисунка видно, что для откорректированного движения фазовые ограничения на полет точки выполнены. Заметим, что промах по цели в конечный момент времени для откорректированной траектории составляет величину 2.02 м .
На рис. 6 показаны трехмерные траектории точки в базовом (штриховая линяя) полете и откорректированном (сплошная линия) полете.
M WnJWv
Шши
^ Ч—rf 7 /
3000
Рис 6
Из рисунка видно, что в момент времени = 5 сек откорректированное движение
почти выходит на базовое движение и в дальнейшем с ним практически совпадает.
Заключение
1. В статье ставится и решается задача управления полетом тяжелой материальной точки в среде с сопротивлением, пропорциональным квадрату скорости в условиях неполной информации об ее начальном положении. Эта информация становится полной только в момент старта.
2. Решение поставленной задачи осуществлено путем сближения возмущенного движения точки с базовым законом ее полета.
3. Указанное сближение реализовано в условиях геометрических ограничений на дополнительные управления.
4. В численном эксперименте показана эффективность применяемых алгоритмов управления.
Список литературы
1. Красовский Н Н. Теория управления движением. М.: Наука, 1968. 476 с.
2. Лутманов С.В. Вариационное исчисление и теория оптимального управления в примерах и упражнениях: учеб. пособие, Перм. ун-т. Пермь, 2010. 200 с.
3. Лутманов С.В. Об одной методике исследования управляемой динамической системы // Вестник Пермского университета. Математика. Механика. Информатика. 2017. Вып. 1 (36). С. 13-20.
4. Лутманов С.В., Кучкова Т.Ю., Овчинников В.А. Управление динамической системой, линеаризованной в окрестности базового движения, в условиях геометрических ограничений на вектор дополнительных управляющих параметров // Проблемы механики и управления: межвуз. сб. науч. тр. Пермь, 2018. Вып. 50. С. 12-32.
5. Лутманов С.В. Хотько О.А. Об одной задаче управления тяжелой точкой, движущейся в среде с сопротивлением, пропорциональным квадрату скорости // Вестник Пермского университета. Математика. Механика. Информатика. 2018. Вып. 3 (42). С. 69-75.
6. Лутманов С.В. Хотько О.А. Оптимальная коррекция полета тяжелой материальной точки в среде с сопротивлением, пропорциональным квадрату скорости // Проблемы
механики и управления: межвуз. сб. науч. тр. Пермь, 2018. Вып. 50. С. 33-45. 7. Лутманов С.В. Коррекция движения управляемого динамического объекта в условиях
воздействия на него неконтролируемой помехи // Вестник Пермского университета. Математика. Механика. Информатика. 2019. Вып. 1(44). С. 14-21.
Correction of flight of a heavy material point in an environment with resistance in the presence of geometric constraints on additional controls
S. V. Lutmanov, O. A. Chotko
Perm State University; 15, Bukireva st., Perm, 614990, Russia mpu@psu.ru; (342)239-63-09
This work is a continuation of a series of articles, devoted to the correction of a perturbed flight of a controlled heavy material point in order to reach its basic law of motion. Flight perturbation is caused not by exact observance of the initial conditions, and movement correction is performed by additional controls included in the differential equations of motion additively to basic controls. considered here that geometric constraints are imposed on the parameters of the additional control in the form of inclusion in a convex compact set. It is shown that if the geometric constraints are not too burdensome, then the movement correction can be successfully implemented.
Keywords: basic movement; disturbed movement; program control; flight correction; quality criterion.