УДК 629.735.45
МОДЕЛИРОВАНИЕ И СТАБИЛИЗАЦИЯ ДВИЖЕНИЙ ВЕРТОЛЁТА С ГРУЗОМ НА
ТРОСЕ
© 2012 С. П. Безгласный
Самарский государственный аэрокосмический университет имени академика С.П. Королёва (национальный исследовательский университет)
Решена задача о построении асимптотически устойчивых произвольных плоских программных движений для вертолёта с грузом на тросе. Программное и стабилизирующее управления получены в виде точного аналитического решения в классе непрерывных функций. Задача решена на основе прямого метода Ляпунова теории устойчивости с использованием функций Ляпунова со знакопостоянными производными.
Двойной маятник, устойчивость, активное управление, стабилизация, функция Ляпунова.
Введение
Задачи по реализации управляемых пространственных движений механической системы имеют важное прикладное значение и широко рассматриваются во многих работах, например [1-6]. В данной работе ставится и решается задача об определении управлений, реализующих и
стабилизирующих произвольно заданные плоские программные движения вертолёта с грузом на тросе постоянной длины. Решение проводится построением активного управления, приложенного к системе тел и представляющего собой совокупность программного управления и
стабилизирующего управления,
осуществляемого по принципу обратной связи. Исследование программного движения сводится к анализу нулевого решения неавтономной системы на основе прямого метода Ляпунова [7] с использованием метода предельных систем [8, 9]. Искомое управление получено в замкнутой аналитической форме в классе непрерывных функций.
Постановка задачи
Рассмотрим плоские движения вертолёта с грузом, прикрепленным на тросе, моделируемого двойным маятником с подвижной точкой подвеса. Пусть вертолёт имеет массу m1, а груз - массу m2. Точки
O, O2 есть центры масс вертолёта и груза,
точка O1 - точка крепления троса к
вертолёту; /1 - расстояние от центра масс
вертолёта до точки крепления троса, /2 -длина троса, постоянная величина. Считаем, что трос не деформируется, нерастяжим и невесом. Тем самым имеем механическую систему - двойной маятник, представляющий собой математический маятник, закрепленный на твердом теле, совершающем плоские вращательные движения относительно подвижного центра масс.
Пусть 0XY есть абсолютная неподвижная система координат. Движение центра масс вертолёта (тела) в плоскости OXY описывается заданным законом:
и = t) вдоль оси OX и в = в(t) вдоль оси
OY .
Исследуем плоские движения описанной механической системы. Поставим задачу о реализации управляющими силами, прикладываемыми к системе, произвольно заданных (программных) движений вертолёта и груза и задачу о стабилизации этих движений.
Программным (желательным
движением) назовем пару (г (У), г (У)) , где
г (t) - ограниченная, дважды кусочно-
непрерывная дифференцируемая вектор-функция, описывающая некоторое заданное движение механической системы.
Уравнения движения
Уравнения движения исследуемой системы составим в форме уравнений Лагранжа второго рода [10]:
(] ( дТЛ дТ
а дТ _дТ = Q . (1)
dt
dq j dq
Пусть центр масс тела движется в плоскости OXY со скоростью б) , где символ ( )
обозначает транспонирование. Положение вертолёта относительно кениговой системы координат Oxy будет характеризоваться углом р , а положение троса - углом у , отсчитываемым от вертикали. Примем данные углы за обобщенные координаты и запишем кинетическую энергию системы:
T =1 mj (й2 +в2) +1 m2 (/j2ф2 + 2/j/2фу cos ( р -у) +
+122у2 + 2ljфи cos ( р) + 2l2yv cos (у ) + 2ljфв sin ( р) +
+21уув sin (у ) +11рф2 + v2 +в2 j,
где 1р - момент инерции корпуса вертолёта. Представим T = T2 + Тр + T0, где
T2 = 1 qTA (t, q) q - квадратичная форма
скоростей q , задаваемая симметричной
матрицей A(t, q) ; Тр = BT (t, q) q - линейная
форма скоростей q , определяемая вектором-
столбцом B (t, q) ; Т0 = Т0 (t, q) - скалярная
функция. Тогда уравнения (1) запишутся в следующем виде:
Í
Aq + M +
дБ дБ
,Т\
дх дх
^ дБ дТ0 ^
q= б, (2)
дt дq
где через M = M (q, q) обозначен-вектор
столбец с компонентами, вычисляемыми по формуле:
2 да.. 1 2 да,. í —\
Mt = Z -^44 - 1 Z 1TkL4k4J, (i = 1,2)
j¿=i д4* J 2 J¿=i д4,■ J V ■
Вектор обобщенных сил Q = ^ + Qs в правой части (2), представляет собой сумму программных Qp и стабилизирующих Qs
сил. Предполагаем, что движение происходит без воздействия внешних возмущающих сил. Запишем уравнения движения в скалярном виде: I р + m2lp2 р + m2lxv cos ( р ) + т21рв sin ( р ) -
-m2lpl2y cos ( р - у) + m2lpl2y2 sin ( р - у) +
+m.
sin ( р) = Q + Q,
mJly + m2l2v cos (у) + т212в sin (у) + +m2lpl2 (cos( р - у) -m2lpl2 ф2 sin ( р - у) + +m2 g^sin (у) = Q;: + Q.
Построение программного и стабилизирующего управлений
Пусть необходимо, чтобы система совершала некоторое программное данное движение системы гТ (у) = ( ),у*(у)),
гТ (у) = ( ф*(г),у*(у)) Определим, как и в [6],
управляющие силы, реализующие это движение:
Qp = Ar + M (r, r) +
дБ дБ
Т Л
д4 д4
r+
дБ дТ
дt д4
Подставив силы в уравнения (2), имеем управляемую систему, для которой программное движение г (У), г (У) является
решением, но, вообще говоря, не является устойчивым. Исследуем и решим задачу о его стабилизации, состоящую в определении сил, обеспечивающих асимптотическую устойчивость исследуемого движения.
Введем отклонения х = q _ г (У). В силу
линейности замены и линейности оператора дифференцирования структура уравнений Лагранжа при переходе к уравнениям в отклонениях не изменится, и, аналогично [11], уравнения возмущенного движения примут вид:
(
Ax + M + M' +
dB 5B
т\
dx дх
x + Ar +
í
+M'' +
дВ дВ
T
дх дх
j. дВ дТ0 r +---0 = Q + Q ,
дt дд *s *р
(3)
M, = Z
д_а_1
j ,k=l дХк
'XkXj
1 2 1 z
да.
2 j,k=1 дхi
M'=± ^ -1 z *
i ¿—t Я,, k j o ¿—t
kj
j,k=1 ^xk 2 j,k=1 + Z ^ -1 Z j
' xkxj,
xkrj +
rkxj,
],к=1 2 -,к=1
2 дп 1 2 ^п , -,
Ы" = V —-г,т.--У -^-пг.,[1 = 1,2).
г ^ Яг к - 2 ^ Яг к - V - ,к=\^лк 2 - ,к=1
Функцию Ляпунова выберем в виде:
V [t, х, х) =1 хтСх +1 хт Ах . у ' 2 2
Функция (4) является определенно-
положительной и имеет производную в силу
системы (3):
(4)
dV = 1 xT dt 2
гдA дА -V • т -г — + \x + x Cx -x M" + at oxT )
+x
-M' +
дВ дВ
т\
дx дx
x-
дВ дВ
т\
Kдx дx )
r -
дА дА . дВ дТ0 1 ^
--x--r--+ —0 - Ar +—N + Q
дл дл дл 6x 2
где символом N обозначен вектор-столбец с компонентами
да.
да..
- UU,. " UU:. ¡ -\
N = ZÍjx»x, jjj • (i = ^
j ,k=1
Определим стабилизирующее управление равенством:
Qs = -Cx - Dx +
/ дВ дВт л
Кдк дк j
r +
, ,„ дВ дТ0 ... _ +M +---0 + Ar + Q ,
дл ex р
(6)
где матрицы C и D являются ограниченными и неисчезающими и выбираются из условий:
c0E < C = const < CjE, (0 < c0 < c - const); d0E < D (t, q) = const < dlE, (0 < d0 < dl - const); dA
2D + — > a0 E, ( 0
dt
< a - cons
t).
где через Ы, Ы' и Ы" обозначены соответственно компоненты квадратичной, линейной и нулевой по скоростям векторных форм:
Тогда производная функции (4) имеет оценку
dV ^T f 1 ЯА ^V an ii-i|2 л
-= -xT\--+ D \ x <—0-\\x\\ < 0
dt \ 2 Яг ) 2 11 11
и является определенно-отрицательной функцией по скоростям. Таким образом, на основе теоремы об асимптотической устойчивости из [9] имеем асимптотическую устойчивость исследуемого программного движения.
Приведем стабилизирующие управления в скалярном виде
Qd = -c11 x1 + m2l1l2i-2 sin (q) + x1 - y* - x2 ^ + +d11 i1 + m2l1l2y*2 sin iqq* + x1 - y * - x2 +
+2Ixq) + m2llv cos (cp* + x1) + m2l1Ó sin ((p* + x1) + +2m2lJ2ft* cos (p* + x1 -Щ* - x2) + 2m2l(* --m2l1p*v sin (pP + x1) + m2llp*Ó cos (pP + x1);
Qc = -c22x2 + d22x2 + m2l2v COs (w* + x2 )--m2lxl2 (p*2 + xj2) sin (pP + x1 - y* - x2) +
+m2l2 (ё - y*v) sin (y* + x2) + 2m2l1¡y* +
+2m2ljl2p* cos (p* + xl - y* - x2) +
+m2l2У*ё cos (y* + x2).
Отметим, что при выборе программного и стабилизирующего управлений
предложенным способом заданные движения реализуются при любых законах плоского движения центра масс вертолёта O: v = v(t), ё = ё(г).
Результаты работы развивают и обобщают соответствующие результаты из
[5, 6, 11].
Библиографический список
1. Афанасьев, В.Н. Математическая теория конструирования систем управления [Текст] / В.Н. Афанасьев, В.Б. Колмановский, В.Р. Носов - М.: Высш. шк., 1989. - 447 с.
2. Летов, А.М. Динамика полета и управление [Текст] / А.М. Летов - М.: Наука, J969. - 359 с.
3. Галиуллин, А.С. Построение систем программного движения [Текст] / А.С. Галиуллин, И.А. Мухаметзянов, Р.Г. Мухарлямов, В.Д. Фурасов - М.: Наука, J97J. - 352 с.
4. Зубов, В.И. Проблема устойчивости процессов управления [Текст] / В.И. Зубов -Л.: Судостроение, J980. - 375 с.
5. Безгласный, С.П. О реализации одноосной и трехосной ориентации системы двух тел [Текст] /С.П. Безгласный, О.А. Мысина // Вестник Самарского государственного университета. 20JJ. № 83. С. 80-90.
6. Bezglasnyi, S.P. The stabilization of program motions of controlled nonlinear mechanical system [Text] // Korean J. Comput. Appl. Math. 2004. V. J4, № J-2. P. 25J-266.
7. Руш, Н. Прямой метод Ляпунова в теории устойчивости [Текст] / Н. Руш, П. Абетс, М. Лаула - М.: Мир, J980. - 30J с.
8. Artstein Z. Topological dynamics of an ordinary equations // J.Differ. Equat. J977. V. 23. P.2J6-223.
9. Андреев, А.С. Об асимптотической устойчивости и неустойчивости нулевого решения неавтономной системы [Текст] / А.С. Андреев // ПММ J984. Т. 48. Вып.2. С. 225-232.
J0. Маркеев, А.П. Теоритическая механика: учеб. для вузов. Издание второе, дополненное [Текст] / А.П. Маркеев - М.: ЧеРо, J999. - 572 с.
JJ. Безгласный, С.П. Стабилизация программных движений уравновешенного гиростата [Текст] / С.П. Безгласный, М.А. Худякова // Вестник Удмуртского университета. Математика. Механика. Компьтерные науки. 20J0. Вып 4. С. 3 J-38.
STABILIZATION OF STEADY MOTIONS OF A SINGLE ROTOR GYROSTAT WITH A CAVITY FILLED WITH A LIQUID OF HIGH VISCOSITY
© 2012 S. P. Bezglasnyi
Samara State Aerospace University named after academician S.P. Korolyov (National Research University)
The problem of constructing asymptotically stability arbitrarily given flat program motions of the helicopter with tethered payload is solved. Program control and stabilizing control is done in the form of an exact analytical solution in the class of continuous functions. The problem is solved by direct method of Lyapunov stability theory with Lyapunov's functions with constant sign of the derivatives.
Doub/e pendu/um, stability, active control, stabilization, Lyapunov's function.
Информация об авторе Безгласный Сергей Павлович, кандидат физико-математических наук, доцент кафедры теоретической механики, Самарский государственный аэрокосмический университет имени академика С. П. Королёва (национальный исследовательский университет). E-mail: [email protected]. Область научных интересов: теоретическая механика, теория управления и устойчивости, динамика систем твёрдых тел.
Bezglasnyi Sergey Pavlovich, candidate of physical and mathematical sciences, associate professor. Samara State Aerospace University. E-mail: [email protected]. Area of research: theoretical mechanic, theory of control and stability, dynamics of systems of rigid bodies.