ВЕСТНИК ПЕРМСКОГО УНИВЕРСИТЕТА 2018 Математика. Механика. Информатика Вып. 3(42)
УДК 519.7
Об одной задаче управления тяжелой точкой, движущейся в среде с сопротивлением, пропорциональным квадрату скорости
С. В. Лутманов, О. А. Хотько
Пермский государственный национальный исследовательский университет Россия, 614990, г. Пермь, ул. Букирева, 15 mpu@psu.ru; 8 (342)239-63-09
Решается задача построения программного управления полетом материальной точки в однородном поле тяжести с учетом сопротивления среды, пропорциональным квадрату величины скорости точки. На траекторию полета наложены фазовые ограничения, заключающиеся в том, что она лежит в некоторой полосе, непересекающейся с поверхностью земли и обрывающейся на заданной цели в конечный момент времени. Решение задачи реализовано в соответствии с методикой, разработанной в работе [2]. Приводятся результаты численного эксперимента, иллюстрирующего эффективность решения поставленной задачи.
Ключевые слова: базовое движение; возмущенное движение; линеаризованная модель; оптимальное управление; программное управление.
DOI: 10.17072/1993-0550-2018-3-69-75
1. Уравнения движения управляемой точки
Предполагается, что движение управляемой материальной точки происходит в однородном поле тяжести в среде с сопротивлением, пропорциональным квадрату скорости точки. Начало абсолютной системы координат 0ху2 помещаем на поверхность земли на место старта управляемой точки. Ось 02 направляем вертикально вверх (см. рис. 1).
z
x
Рис. 1
Уравнения управляемого движения точки в выбранной системе координат имеют вид
mx = —k ( x2 + y2 + z2
7
my = —k (x2 + y2 + z2)
x2 + y2 + z2 y
sjx2 + y2 + z2
r + v,,
-k (x
mz = —k (x2 + y2 + z2
4
или
k
• • 2 • 2
x =--x •J x + y + z +--Vj,
m m
x2 + y2 + z2
1
+v
— mg + v3,
k
1
. / . 2 «"2 T
y =--У •>/ x + y + z +—V2,
mm
1
(1.1)
k
- - • /'2 «2 «2 z =--z •yjx + y + z — g + — v3,
mm
где m — масса точки, k = const — коэффици-
(v \
ент пропорциональности и
e R — век-
V V3 У
тор управляющих параметров.
v
2
© Лутманов С. В., Хотько О. А., 2018
2. Описание кинематики полета и постановка задачи
Полет управляемой точки начинается в момент времени t0 и заканчивается в момент времени Т > t0 на поверхности земли в положении хТ, уТ, 2Т . Сначала точку подбрасывают вверх с поверхности земли. Этот этап ее движения в работе не моделируется. В результате точка принимает положение х0, у0, г0 и приобретает начальную скорость
Х0, у0, 20. При этом точка должна находиться на расстоянии не менее е > 0 и не более 2е > 0 от поверхности земли, а ее начальные горизонтальные координаты х0, у0 мало отличаться от нулей. Относительно вектора скорости принимается, что
Т —1
^ У0
Ут
т — г
т — и
Рельеф местности моделируется гладкой функцией двух переменных р: Я2 ^ Я1. На начальном этапе полета должно выполняться двойное неравенство р(X(г),у (г)) + £ < 2(г) < р(X(г),у (г)) + 2е,
г е[г0, г *],
где г*е[г0, Т]— заданный момент времени.
Далее е — полоса сужается и в конечный момент времени Т вырождается в точку, совпадающую с целью полета. Указанное требование реализуется посредством выполнения двойного неравенства
р( х (г), у (г))
+£-1 -Т-4 1< 2 (г )<
Т — г •
<
р( х (г), у (г)) + 2е
Т — г Т—г"
г е| г
[г, Т ]
на заключительном этапе полета.
Управление движением точки будем осуществлять в классе программных стратегий.
Определение 1. Произвольная интегрируемая вектор-функция V : [г0, Т] ^ Я3, называется программным управлением точкой на промежутке времени [г0, Т].
Сформулируем основную задачу, решаемую в данной статье.
Задача 1. Определить программное управление V0 (-) точкой, обеспечивающее выполнение требований, предъявляемых к кинематике полета точки сформулированных в данном пункте.
3. Построение базовой траектории и базового программного управления
Решение задачи 1 начинается с построения кинематического закона движения точки удовлетворяющего всем требованиям, предъявляемых к кинематики полета.
С этой целью полагаем
Х0 = 0 у0 = 0 Х0 = ■
Т —
^ .у0 =
ут — .У0 Т—гп
х (г) = ^ + х (г — ) ,
у (г) = у0 + у0 (г — to), г е[г0,Т].
гТг = г гТг = гТг + Д ... гТг = гТг + Д = Т
Т — г
Д =
(3.1)
Не теряя общности, считаем, что для некоторого номера Дс < 5 выполняется равенство гТТ = г *. В противном случае разбиение промежутка времени [г0, Т ] можно сделать
частично неравномерным.
Далее нарабатывается массив точек
(с, ), (с, 21ТГ),..., (гТг, 2? ) , (3.2)
где
2 Тг = р( 0,0 )+ 2е, 21Тг е[р(X (гТ ), у (гТг)) + е, р(X (гТг), у (гТг))+ 2е
+ е,
< е[р( X (С), у (С))
((xе (С), у (С ))+ 2е
р(Xе (С), у (С ))+ е
Т —
^ 5с +1
Т —
((xе (С), у (<+1)) + 2е
Т — гТ
Т — гТ
р( Xе (гТ—1), у (С)) + е
Т —
1 1д — 1
Т — гТ
((Xе (гТ—1), у (С ))+ 2е
Т — ^
1 1д — 1
' т — е
2ГГ = 2Т 5 Т
2Т 20
0
0
2 , е
д. +1
е
2
д — 1
Функциональная зависимость
2(г) — /(Г), t Т]
устанавливается путем интерполяции массива точек (3.2). В результате получим
/(t) —I«/ .
1=0
Определение 2. Кинематический закон движения точки
х (t) = Х0 + х0 (г" *0 ), У (t ) = у0 + у0 (t - *0 ) , 2(0 = }(г), г е Т]
(3.3)
будем называть базовым законом движения.
Непосредственно проверяется, что он удовлетворяет всем требованиям, предъявляемым к кинематике полета из пункта 2. Определение 3. Программное управление
V — ЭД, t е[г0, Т],
реализующее базовый закон движения точки, назовем базовым программным управлением.
Для построения базового программного управления уравнения (1.1) разрешаем относительно управлений:
гх + кх-д/х2 + у2 + 22,
v2 = ту +
У + ку-4-
х2 + у2 + 2 2;
(3.4)
1'2 + к2х2 + у2 + 22 + mg.
Базовый закон движения (3.3) подставим в уравнения (3.4). В результате получаем искомые базовые управления
V (г ) = тх(г) +
+кх (гх2 (г) + у2 (г) + 22 (г), V)2 (г ) = ту (г) +
+ку(г)-7¿2 (г) + у2 (г) + 22 (г),
V (г) = т2 (г ) +
+к2 (г) х2 (г) + у2 (г) + 22 (г) + тя.
4. Возмущенные движения и возмущения
Из приближенных равенств
х0 ~ х0, у0 ~ у0,20
) ,
2 (*0 )
х0 ~ х0 , у0 ~ у0, 20 следует корректность представления
х0 = -х0 + 8x0, у0 = у0 + 8у0 , 20 = 2 (?0 ) + 820,
х0 = х0 + у0 = у0 + 8Уo, 20 = 2 (?0 ) + 820,
где величины 5х0,5у0,520,5х0,5у0,520 малы.
Определение 4. Решение х = х(г), у (г) = у(г), 2 = 2 (?), г е[?0, Т ]
системы дифференциальных уравнений к .
■ •_ к . г
х —--х • \1 х
т
+1 ^(?),
2 , • 2 . -2 . х + у + 2 +
у=—у •4х
т
+ - V (?),
т
. ■ к . х
2 —--2 • -у х
х2 + у2 + 22 +
(4.1)
х2 + у2 + 22 -
-Я +-V)з (?), т
с начальными условиями
х (?0 ) = x0, у ( ?0 ) = Уo, 2 (?0 ) = 20,
х(?0) = x0,у (?0 ) = y0, 20 (?0 ) = 20 назовем возмущенным движением.
Определение 5. Разности
8х (г) — х (г)-х (г), 8у (г) — у (г)-у (г), 82(г) — 2(г)-2(г), г е[г0,Т]
назовем возмущениями.
В случае, если в некоторый момент времени возмущения и их производные обратятся в ноль, то начиная с этого момента времени возмущенное движение совпадет с базовым и, следовательно, удовлетворит требованиям, предъявляемым к кинематическому закону движения точки. Обращение в ноль возмущений будем осуществлять посредством дополнительных управлений щ, и2, и3, которые введем в дифференциальные уравнения движения (1.1) аддитивно основным управлением, т. е.
к .
V- 2 -2 -2
х + у + 2 +
т
+ — (V1 + и1), т
•• к • I • 2 -"2 -"2" у —--у-^х + у + 2 +
т
+ — (V2 + и2 ) , т
k .
V- 2 -2 -2
х + у + 5
m
где
~8 +—(V + и3).
m
(4.2)
Динамика возмущений с высокой степенью точности описывается линеаризованной в окрестности пары "базовое движение, базовое управление" системы дифференциальных уравнений (1.1).
Заменой переменных
x = я, у = У2> 2 = Уз,
x = У4, У = У5, 2 = Уб
нормализуем уравнения (1.1). В результате получим
У1 = У4, У2 = У5, •Уз = Уб,
• к . /. 2 «""2 1 / \
У4 =--У4 'V У2 + У5 + Уб + —(V + и1 ) ,
т т
к
■У5 'л/У42 + У5 + Уб2 +
т
• к . 1. 2 Г"? Г2 1 / \
У5 =--У5 -VУ4 + У5 + Уб + ~(V + и2 ) ,
тт
• к • I • 2 1 / \
Уб =--Уб 'VУ4 + У5 + Уб - 8 + ~(V + и3 )
т
Обозначим
У (t ) = х (t), У>2 (t ) = У (t), .Уз (t ) = 5 (t), У4 (t ) = х (t), У5 (t ) = У (t), Уб (t ) = 5 (t),
t е[г0, Т ],
1 (У4, У5 , Уб, V! ) = - ку4 т
У4 -V У42 + у52 + уб2 +
т
1 (У4, У5 , Уб, V ) = - ку5 т
У5 Ч У42 + У5 + уб2 +
+ -V2 т
1б (У4, У5 , Уб, V ) = - куб ->/Й т
Уб -л/ У42 + У5 + Уб2
8 + — Vз. т
Тогда искомая линеаризованная система дифференциальных уравнений имеет вид
х = А (t) х + В (t) и,
(4.3)
х =
Г х ^
х2 Г и1 1
х3 , и = и2 Vи3 у
х4 х5
V хб
А (' ) =
Г 0 0 0 1 0 0 1
0 0 0 0 1 0
0 0 0 0 0 1
0 0 0
9У5 9Уб
0 0 0 д¥1_
дУ5 дУб
0 V 0 0
дУ5 дУб у
у,= у,(>), 1=1,—,б
VJ=VJ('),
¿=1,2,3
В «) =
Г 0 0 0 1
0 0 0
0 0 0
д¥±
5У1 ^2 ^3
915 911
5у1 ^2 ^3
91, 91,
V ^2 ^3 у У,=у, (' ) ¿=1,—,б
Г0 0 01
0 0 0
0 0 0
т 0 0
0 т 0
.0 0 1 т у
5. Приведение вектора возмущений в начало координат и решение основной задачи
Поставим задачу о построении дополнительного управления и (-) , приводящего вектор возмущений в начало координат в момент времени t .
Эту задачу аппроксимируем задачей о приведении фазового вектора линейного управляемого объекта (4.2) из начального положения
х1 (Ч ) = ¿^ х2 (^ ) = ¿У0
х3 (Ч ) = ¿z0, х4 (t0 )= ¿X0, (5Л)
х5 (t0 )= ¿^ хб (t0 )=
в начало координат в момент времени t . Предполагая, что на вектор управляющих параметров и не налагается геометрических
1
1
1
ограничений, дополнительно потребуем, чтобы среди всех других программных управлений, решающих задачу наведения фазового вектора линейного объекта на начало координат, искомое программное управление доставляло наименьшее значение функционалу
I [и (■ )] =
t
| (и (т), и (т)^ dr
(5.2)
В литературе, например [1], величина (5.2) считается пропорциональной энергетическим затратам, и поэтому задача управления по критерию (5.2) носит название задачи управления на "минимум энергии".
Таким образом, дополнительное программное управления и0 ( • ) находится как
решение следующей задачи.
Задача 2. Определить программное
управление и0 ( • ), переводящее фазовый вектор
управляемого линейного динамического объекта (4.3) из начального положения (5.1) в начало координат в момент времени г * и при этом доставляющее минимум функционалу (5.2).
Следуя монографии [1] и учебному пособию [3] изложим кратко алгоритм решения задачи 2. Пусть
X [t ,т] =
V x6i t,r
xi6 t,r
x66 t,r у
t,r e t0,T
- фундаментальная матрица Коши для однородного векторного дифференциального уравнения х — А ( г) . Полагаем
Г /»«( г
Н [Т, г] — X [Т, г]в (г)— •••
h(6)( t)
hi(1)(t) h21)(t) h«(t h(6)(t) h26)(t) h36)(t)
t e[to, T ].
Матрицу Н[Т,г], г е[г0,Т] назовем переходной матрицей линейного динамического объекта. Символом
Л(,)(г) — (г) )(г) $)(г)), 1 — 1,-,6
обозначим , -ю строку переходной матрицы.
Оптимальное управление и0 (г), г е[г0, Т], строится по формуле
6 / , Т
и0 (•) — 17° (^ >(•)) ,
,—1
в которой числа 7,7(0 являются решением системы линейных алгебраических уравнений
Г«и • «16 У 711 Г О
a. 6i ••• «66 yv6 У V С6 у
где
= í((hW(r))T , (h°)(r})^dr, i, j = i,
tn
= 1,-,6,
ir Л
= -X [t , tn ] xn .
V r6 У
Программное управление V0 (•), решающее основную задачу 1, строится по формуле
"V(г)+и0 (г), г е[г0,г*] V) (г) г е( г", Т ].
v (t Н
6. Численный эксперимент
Изложенная выше теория иллюстрируется на следующих числовых данных:
м
сек
k = 0.45, m = 1ППкг, g = 9.8
s = 30м, tn = 0, T = 10сек, ( ( x, y ) =50 ■ sin ( 0.00005 ■ x ■ y ) м, x0 = -40 м, y0 = 20 м, z0 = 40 м, xT = 3000м, yT = 100м, ,
zT = (( xT, yT ) = 32.51 м,
~ , ~ м . м
x0 = 310-, У0 = -10-,
сек сек
z0 = -12.75 —, ^ = 100, сек
t* = 5 сек ^ sc = 50, n = 15 .
Приведем графики совместной реализации во времени координаты z (t) точки и
профиля рельефа местности (р(х(t),у(t))
вдоль траектории движения точки (профиль рельефа местности вдоль траектории изображен на графиках жирной линией).
На рис. 2 изменение координаты г (t)
отвечает базовому движению точки
На рис. 3 изменение координаты г (t) отвечает возмущенному движению точки
Из графика видно, что в случае возмущенного движения на втором этапе полета точка врезается в землю, не долетев до цели.
На рис. 4 изменение координаты г (t)
отвечает откорректированному движению точки.
На рис. 5 приведен график высоты полета точки в зависимости от времени для откорректированного движения.
Из графика видно, что откорректированный закон движения точки удовлетворяет всем требованиям, предъявляемым в пункте 2 к кинематике полета.
В заключение вычислим величину промаха по цели для возмущенного полета (в предположении, что столкновение с землей полет не прервало) с промахом в откорректированном движении.
Величина промаха для возмущенного движения
Чад^Т =
= 70.49 м.
Величина промаха для откорректированного движения
= 2.81 м.
Заключение
В статье решена задача наведения на цель управляемой точки, движущейся в однородном поле тяжести в среде с сопротивлением, пропорциональным квадрату величины скорости точки и с учетом фазовых ограничений на траекторию полета. В случае не точного выполнения начальных условий на старте в работе предусмотрено введение дополнительного программного управления, возвращающего точку на базовую траекторию. Дополнительное управление при этом является оптимальным в смысле критерия "минимум энергии".
Результаты численного эксперимента подтверждают корректность примененных алгоритмов решения задачи.
Список литературы
1. Красовский Н.Н. Теория управления движением. М.: Наука, 1968. 476 с.
2. Лутманов С.В. Об одной методике исследования управляемой динамической системы лиц // Вестник Пермского университета. Математика. Механика. Информатика. 2017. Вып. 1(36). С. 13-20.
3. Лутманов С.В. Вариационное исчисление и теория оптимального управления в примерах и упражнениях: учеб. пособие / Перм. гос. ун-т. Пермь, 2010. 200 с.
On a problem of control of a heavy point moving in a medium with resistance proportional to the square of the speed
S. V. Lutmanov, O. A. Khot'ko
Perm State University; 15, Bukireva st., Perm, 614990, Russia mpu@psu.ru; 8 (342) 239-63-09
The article solves the problem of aiming at the target of a material point in a uniform gravity field, taking into account the resistance of the medium proportional to the square of the point velocity. The flight path is subject to phase constraints, which are that it lies in a certain band that does not intersect with the earth's surface and breaks off at a given target at a finite time. The results of a numerical experiment illustrating the effectiveness of the solution of the problem are presented.
Keywords: basic motion; perturbed motion; linearized model; optimal control; software control.