CC BY
187
УДК 681.51
Метод синтеза системы управления колебаниями перевёрнутого маятника с инерционным маховиком1
А. А. Колесников
(Южный федеральный университет)
Рассматривается задача управления известной системой, состоящей из перевёрнутого маятника с неподвижной точкой подвеса. При этом на маятнике закреплён электродвигатель с маховиком. Ротор электродвигателя жёстко соединён с маховиком. Вращением маховика можно стабилизировать маятник в определённом положении. Развиваемый электродвигателем маховой момент приложен как к его ротору (т. е. к маховику), так и к его статору (т. е. к маятнику). Требуется перевести маятник в верхнее неустойчивое положение и в этом положении стабилизировать его — добиться автоколебаний с определёнными амплитудой и частотой. Синтезирован новый закон управления перевёрнутым маятником, обеспечивающий его устойчивость в верхнем положении. Данный закон управления основан на энергетических инвариантах системы.
Ключевые слова: перевёрнутый маятник с маховиком, устойчивость в верхнем положении, закон управления, энергетические инварианты.
Введение. Управление перевёрнутым маятником с неподвижной точкой подвеса, перевод его в верхнее неустойчивое состояние и стабилизация этого неустойчивого состояния — важные классические проблемы в механике, теории колебаний и теории управления. Рассмотрим задачу управления известной системой, состоящей из перевёрнутого маятника с неподвижной точкой подвеса. При этом на маятнике закреплён электродвигатель с маховиком. На рис. 1 представлена реальная конструкция такого маятника, разработанная в Институте механики МГУ [1]. Ротор электродвигателя жёстко соединён с маховиком, вращением которого маятник может быть стабилизирован в определённом, например верхнем, положении. Развиваемый электродвигателем маховой момент приложен как к его ротору (т. е. к маховику), так и к его статору (т. е. к маятнику). Этот момент управляет движением маятника [1, 2]. В работе [1] указывается, что такой способ управления маятником можно строго доказать на основе теоремы об изменении момента количества движения системы относительно точки подвеса маятника [3, 4].
В прикладном плане рассматриваемая здесь задача стабилизации перевёрнутого маятника с помощью управляемого маховика имеет непосредственное применение, например, в космонавтике, когда управление ориентацией спутника осуществляется при помощи гиродинов [2]. Аналогичный способ управления используется и в других областях техники [5-8].
В [9] представлена кинематическая схема маятниковой системы (рис. 2). Ставится следующая задача управления: требуется перевести маятник в верхнее неустойчивое положение и стабилизировать его в указанном положении в форме автоколебаний с определёнными амплитудой и частотой.
1 Работа выполнена по гранту Южного федерального университета «Синергокибернетический подход к созданию интеллектуальных систем навигации и управления сложными системами, функционирующими в экстремальных условиях».
Рис. 1. Перевёрнутый маятник с маховиком: 1 — маятник; 2 — ось маятника; 3 — маховик; 4 — ось маховика; 5 — шестерня редуктора; 6 — двигатель; 7 — датчик угла поворота маховика; 8 — датчик угла поворота маятника
Рис. 2. Кинематическая схема маятника: 1 -маятник; 2 — ось маятника; 3 — маховик; 4 ось маховика; 5 — электродвигатель
1. Модель маятника с маховиком. Дифференциальные уравнения динамики маятника с инерционным маховиком приведены в работе [9] и имеют следующий вид:
рЛф (£) + ( Jr + ЛJm) со ^) = (МЬ + mh) дЛ^пф,
{(Л + ЛJm)Лф(0 + (л + Л2Jm)о(^ = ЛТ, ( )
где ф — угол крена маятника; о — скорость вращения маховика относительно маятника; ]т — момент инерции маховика относительно его главной оси (оси вращения); ]г — момент инерции ротора электродвигателя; J = Jv + Jr + Jm + тії2 — полный момент инерции системы «маятник — маховик — двигатель», где через Jv обозначен момент инерции маятника относительно его оси вращения; д — ускорение свободного падения; М, m — массы маятника и двигателя; Ь, і — расстояния от оси вращения до центров масс маятника и маховика (с ротором двигателя); Т — момент электромагнитных сил, приложенных к ротору двигателя; Л — коэффициент редукции, о = ЛФ, где Ф — скорость вращения ротора двигателя.
С учётом противо-ЭДС реакции якоря величину момента Т можно приближённо (пренебрегая электромагнитной постоянной времени) представить в виде
Т = си - с2оЛ 1, (2)
где и — управляющее напряжение в цепи якоря двигателя; с1, с2 — параметры двигателя [9].
Уравнения (1), (2) описывают нелинейную динамическую систему третьего порядка с переменными состояния {ф,ф,о} и входным управляющим воздействием и. Вертикальному (неустойчивому) положению равновесия соответствует значение ф = 0 [9]. Параметры модели (2) [9]:
М = 1 кг, m = 3 кг, і = 0,13 м, J = 0,12 кг • м, Jm = 0,003 кг • м2, Jr = 10-4 кг • м2, (3)
Ь = 1 м, Jv = 3,92• 10 2 кг • м2, Л = 0,1, с = 8 • 10-2 Н • м/В, с2 = 7,(3 • 10-3 Н • м • с ( )
Разрешив уравнения маятника (1), (2) относительно ф(Ь) и О (Ь) и подставив параметры (3), получим следующую модель маятниковой системы с маховиком [9]:
Гер (Ь)- 6,14ш - 50,1біп ф = -6,46и, (4)
(Ь) + 23,8ш + 38,8Бтф = 25и, ( )
Полная энергия маятниковой системы (1) равна
Н(ф,ф,ш) = (МЬ + mh)д(1 - соБф) + 0,5(З + Jm + mh2)ф2 (Ь) +
+ J Л1 + 2Jm) шф (t) + (jm + 0,5JrA2) ш2. (5)
Подставив в (4) параметры (3), получим
H (ф, ф, ш) = 4,81 (1 - cos ф) + 0,1ср2 (t) + 0,06шф (t) + 0,035ш2. (6)
2. Синтез закона управления с парциальной энергией. Для синтеза закона управления, стабилизирующего маятник (1) в верхнем неустойчивом положении, используем энергетический инвариант в виде полной или парциальной энергии. Другими словами, для синтеза закона управления можно использовать как полную энергию (6), так и парциальную её составляющую
Нф (ф,ф) = (Mb + mh) g(1 - cosp) + 0,5 (J + Jm + mh2) ф2 (t), (7)
отражающую энергию колебаний маятника (1) с неподвижным маховиком. Рассмотрим метод синтеза закона управления на основе парциальной энергии (7), которая с учётом параметров (3) имеет вид
Нф (ф,ф) = 4,81 (1 - cos ф) + 0,1ф2 (t). (8)
Выберем в качестве макропеременной следующую функцию:
Фф = Нф -Н0, (9)
где Н0 — заданный уровень энергии.
Для синтеза закона управления введём следующее инвариантное соотношение:
Тф ф (t) + ФфФ2 (t) = 0. (10)
Тогда, подставив в (10) функции фф (9), Нф (8), в силу уравнений (4) получим закон управления:
6,46иф = 74,15s^ + 6,14ш + — Ффф (t). (11)
Т1
Этот закон сначала переводит изображающую точку замкнутой системы (4), (11) на инвариантное многообразие Фф = 0 (9). Подставив закон управления иф (11) в первое уравнение системы (4), получим следующее уравнение движения маятника:
Ф (t) + 24,05 sin ф + Т ффф (t) = 0. (12)
' 1
Из (12) следует, что движение маятника с остановленным электроприводом на многообразии Фф = 0 (9) будет описываться уравнением
ф (t) + 24,05s^lv = 0. (13)
Это уравнение колебательной системы с соответствующей амплитудой и частотой колебаний. Аналогично из исходного соотношения (9) имеем
Фф = 4,81 (1 - cos ф) + 0,1ф2 (t)- H0.
Продифференцировав данное выражение по времени, находим
ф (£) + 24,05 sin фф = 0 , (14)
Мы видим, что (14) совпадает с (13) и, следовательно, также является колебательной системой. Из (13) и (14) следует, что частота колебаний равна шф = л]24,05. Это частота колебаний
маятника с остановленным электроприводом. Однако согласно (5) полная энергия Н с вращающимся электроприводом включает в себя помимо парциальной энергии Нф (8) также и
составляющую Нш = (JrЛ 1 + 2Jm) шф(ь) + (Jm + 0,5JrЛ 2) ш2, отражающую энергию динамического взаимодействия маятника и вращающегося электропривода. В целом, это означает, что, учитывая закон управления иф (11), маятник реально будет колебаться с частотой, меньшей шф = -^24,05 .
Формально, если подставить закон управления иф (11) во второе уравнение системы (4), то
получим следующее уравнение движения на многообразии ф1 = 0 :
шф (^ + 0,04шф = 249,9 sinфф . (15)
Очевидно, что (15) — это также уравнение колебательной системы с определённой амплитудой и частотой колебаний. Итак, из приведённых рассуждений, основанных на использовании парциальной энергии Нф (8) для синтеза закона управления иф (11), следует, что маятник с
вращающимся маховиком будет устойчиво колебаться около верхнего неустойчивого состояния с определёнными амплитудой и частотой колебаний, зависящими от Н0 и параметров (3) маятника.
3. Результаты моделирования. Для подтверждения изложенных выше соображений смоделируем систему (4) с парциальным законом управления (11). На рис. 3-11 представлены графики изменения угла маятника ф (£) и скорости вращения электропривода ш (£) для разной
задаваемой энергии, начальных условий системы ф0, ф0, ш0 и параметра Т.
О 5 10 15
Рис. 3. Изменение угла ф (Ь) при Н0 = 4,81, ф0 = п/2,
ф 0 = 1 , Ш0 = 1 , Т = 0,1
Рис. 4. Изменение скорости вращения электропривода при Н = 4,81, ф0 = п/2 , ф0 = 1, Ш0 = 1, Т = 0,1
, ф, Рад
►
-1 0 1 ср(ґ), рад/с
Рис. 5. Фазовый портрет F (фф) = 0
Рис. 6. Изменение угла ф при Н0 = 4,81, ф0 = 0,5п , ф0 = 0 , Ш0 = 0, Т = 0,1
Рис. 7. Изменение угловой скорости маятника ф (£) и скорости вращения электропривода при Н0 = 4,81, ф0 = 0,5п , ф0 = 0, Ш0 = 0, Т = 0,1
Рис. 8. Изменение угла ф (^) при Н0 = 4,5, ф0 = 0,45, ф 0 = 1, Ш0 = 1, Т = 0,1
На рис. 7 для сравнения приведены графики изменения скорости ф0 (£) отклонения
маятника от вертикальной оси и скорости ш(£) вращения электропривода. Из этих графиков
следует, что переменные ф0 (£) и ш (£) изменяются в противофазе по отношению друг к другу.
Таким образом, электропривод функционирует как осциллятор. Это позволяет успешно решить поставленную задачу управления автоколебаниями перевёрнутого маятника с инерционным маховиком.
Рис. 9. Изменение скорости вращения электропривода при Н0 = 4,5, ф0 = 0,45 , ф0 = 1, ш0 = 1, Т = 0,1
0 2 4
Рис. 10. Изменение угла ф ^')
6 8 1;, с
при Н0 = 1, ф0 = 1,5,
ф 0 = 1, “с = 1, Т = 0,1
Рис. 11. Изменение скорости вращения электропривода при
1,5 , = 1, Т = 0,1
Как следует из результатов моделирования, закон управления (11) с парциальной энергией обеспечивает устойчивые автоколебания маятника с маховиком. Угол отклонения маятника от верхнего неустойчивого положения — ф0 =-0,8п + 0,8п от начальных условий. Во многих практических случаях этого достаточно для решения поставленных технологических задач, например связанных с ориентацией тел в пространстве и др.
Выводы. В статье синтезирован новый закон управления перевёрнутым маятником, обеспечивающий его устойчивость в верхнем положении. Результаты моделирования замкнутой системы подтверждают эффективность предложенного в статье синергетического метода синтеза систем управления перевёрнутым маятником с инерционным маховиком.
Библиографический список
1. Управление при помощи маховика маятником с подвижной точкой подвеса / А. А. Гришин [и др.] // Известия РАН. Теория и системы управления. — 2002. — № 5. — С. 14-24.
2. Управление при помощи маховика маятником с неподвижной точкой подвеса /
А. В. Безнос [и др.] // Известия РАН. Теория и системы управления. — 2004. — № 1. — С. 27-38.
3. Белецкий, В. В. Двуногая ходьба. Модельные задачи динамики и управления /
В. В. Белецкий. — Москва : Наука, 1984. — 484 с.
4. Голубев, Ю. Ф. Foundations of Theoretical Mechanics / Ю. Ф. Голубев. — Москва :
Издательство МГУ, 2000. — 720 с.
5. Управление мехатронными вибрационными установками / И. И. Блехман [и др.] ; под ред. И. И. Блехмана, А. Л. Фрадкова. — Санкт-Петербург : Наука, 2001. — 278 с.
6. Astrom, K.-J., Swinging up a pendulum by energy control / K.-J. Astrom, K. Furuta // Auto-matica. — 2000. — Vol. 36. — № 2. — P. 287-295.
7. Fradkov, A. L. Nonlinear excitability analysis with application to two-pendulum system / A. L. Fradkov, B. R. Andrievsky, K. V. Boykov // Modeling, Identification and Control : 21st IASTED International Conference (MIC 2002). — Innsbruck. — 2002. — P. 374-379.
8. Spong, M.-W. Nonlinear control of the Reaction Wheel Pendulum / M.-W. Spong, P. Corke,
R. Lozano // Automatica. — 2001. — Vol. 37. — P. 1845-1851.
9. Андриевский, В. Р. Стабилизация перевёрнутого маятника с инерционным маховиком в
качестве движителя / В. Р. Андриевский // Управление в физико-технических системах ; под ред. А. Л. Фрадкова. — Санкт-Петербург : Наука, 2004. — С. 52-71.
Материал поступил в редакцию 05.02.13.
References
1. Grishin, A. A., et al. Upravlenie pri pomoshhi maxovika mayatnikom s podvizhnoj tochkoj podvesa. [Control through flywheel pendulum with movable suspension point.] Izvestiya RAN. Teorija i sistemy upravlenija. 2002, no. 5, pp. 14-24 (in Russian).
2. Beznos, A. V., et al. Upravlenie pri pomoshhi maxovika mayatnikom s nepodvizhnoj tochkoj podvesa. [Control through flywheel pendulum with fixed suspension point.] Izvestiya RAN. Teorija i sistemy upravlenija. 2004, no. 1, pp. 27-38 (in Russian).
3. Beletskiy, V. V. Dvunogaya xod'ba. Model'ny'e zadachi dinamiki i upravleniya. [Biped gait. Dynamics and control model problems.] Moscow : Nauka, 1984, 484 p. (in Russian).
4. Golubev, Y. F. Foundations of Theoretical Mechanics. Moscow : Izdatel'stvo MGU, 2000, 720 p.
5. Blehkman, I. I., et al. Upravlenie mexatronny'mi vibracionny'mi ustanovkami. [Mechatronic vibration machine control.] I. I. Blekhman, A. L. Fradkov, eds. Sankt-Peterburg : Nauka, 2001, 278 p. (in Russian).
6. Astrom, K.-J., Furuta, K. Swinging up a pendulum by energy control. Automatica, 2000, vol. 36, no. 2, pp. 287-295.
7. Fradkov, A. L., Andrievsky, B. R., Boykov, K. V. Nonlinear excitability analysis with application to two-pendulum system. Proc. 21st IASTED Conf. "Modeling, Identification and Control" (MIC 2002). Innsbruck, 18-21 Feb, 2002, IASTED, ASTA Press, pp. 374-379.
8. Spong, M.-W., Corke, P., Lozano, R. Nonlinear control of the Reaction Wheel Pendulum. Automatica, 2001, vol. 37, pp. 1845-1851 / V. R. Andrievskij // Upravlenie v fiziko-texnicheskix sistemax ; pod red. A. L. Fradkova
9. Andrievsky, B. R. Stabilizaciya perevernutogo mayatnika s inercionny'm maxovikom v kachestve dvizhitelya. [Stabilization of the inverted pendulum with inertia flywheel as an engine.] A. L. Fradkov, ed. Upravlenie v fiziko-texnicheskix sistemax. [Physicotechnical systems control.] Sankt-Peterburg : Nauka, 2004, pp. 52-71 (in Russian).
INVERSED PENDULUM WITH SLUGGED FLYWHEEL OSCILLATION CONTROL SYSTEM SYNTHESIS METHOD1
A. A. Kolesnikov
(Southern Federal University)
The problem of a well-known system control consisting of the inversed pendulum with the fixed suspension point is considered. At that, an electric motor with a flywheel is fastened on the pendulum. The motor spindle has a rigid coupling with the flywheel. Its rotation could clamp the pendulum in position. The rotative moment developed by the electric motor is applied both to its rotor (i.e. to flywheel) and to its stator (i.e. to pendulum). The pendulum should be moved to the top instable position, and stabilized in this position — to obtain autooscillations with the specified amplitude and frequency. A new control law for the inversed pendulum to provide stability in top position is synthesized. The control law is based on the energy invariants of the system.
Keywords: inversed pendulum with a flywheel, stability in top position, control law, energy invariants.
1 The research is done on Southern Federal University grant "Synergocybernetic approach to building intelligent systems of navigation and complex systems control operating under extreme conditions".
