Разработка алгоритмов раскачки и стабилизации обратного маятника, закрепленного на валу двигателя
Эмирбеков Н.Э., Эмирбеков М.Э. ФГБОУ ВПО НГТУ, Новосибирск, Россия
Аннотация: Данная статья посвящена разработке алгоритмов раскачки и стабилизации обратного маятника, закрепленного на валу двигателя. Показывается описание математической модели объекта, приводятся нелинейные дифференциальные уравнения,
описывающие его поведение.
Осуществляется переход к линеаризованной модели, для которой проводится исследование основных качественных свойств. Предлагается алгоритм раскачки маятника из устойчивого положения в область точки неустойчивого равновесия. Разрабатывается алгоритм стабилизации, позволяющий обеспечить требуемое качество переходного процесса в системе. Проводится моделирование замкнутой системы в программной среде Matlab 8шн|1шк.
Ключевые слова: обратный маятник, раскачка, стабилизация, регулятор.
ВВЕДЕНИЕ
Проблема раскачки и стабилизации объекта управления «обратный маятник» предпологает решение ряда достаточно сложных задач. Их можно условно разделить на два класса. Первый включает в себя задачи, носящие выраженный исследовательский характер. К ним относится анализ достоинств и недостатков уже известных походов к синтезу системы стабилизации [1-7], позволяющих реализовать в системе процессы заданного качества, моделирования замкнутой системы и анализ полученных результатов. Второй класс задач связан с технической реализацией системы управления, разработку программного обеспечения, отладочных средств.
Особенностью данной работы является то, что здесь рассмотрена система с переменной структурой, то есть в зависимости от параметров объекта управления алгоритм управления изменяется. Задача стабилизации объекта управления «обратный маятник» является актуальной и может иметь достаточно широкие области применения. Данный алгоритм стабилизации может быть применен в робототехнике при движении роботов-гуманоидов [8-9]. С помощью двигателей
изменяется угол расположения составных частей робота, что позволяет сохранить его точку равновесия и не дает ему упасть.
Обсуждаемый объект управления представляет собой однородный стержень, закрепленный на валу двигателя, который управляет его движением при помощи прикладываемой силы. Схематическое представление системы «обратный маятник, закрепленный на валу двигателя» представлено на Рис.1.
Рис.1. Система «обратный маятник, закрепленный на валу двигателя»
Здесь <р(£) - угол отклонения маятника от вертикали (выходная переменная), U(t) -момент прикладываемой силы (выходная переменная), m - масса маятника, 2L - длинна маятника, g - ускорение силы тяжести, H(t) и V(t) - горизонтальная и вертикальная силы реакции у оси маятника.
1. ОПИСАНИЕ МАТЕМАТИЧЕСКОЙ МОДЕЛИ СИСТЕМЫ «ОБРАТНЫЙ МАЯТНИК» И ПОСТАНОВКА ЗАДАЧИ СИНТЕЗА
Модель объекта «обратный маятник» можно получить с помощью уравнений второго закона Ньютона [10]:
J ■-
d
2
dt
<p(t) = LV(t) - LH(t) ■ cosp(t) + U(t) (1)
Для объекта справедливы вспомогательные уравнения:
ТТТ- _
df df
(t ■swapО]) =йй
[I -costpit)) = V(£> - mg
(2)
Здесь 3 - момент инерции маятника, который рассчитывается по формуле:
J=
ml-12
(3)
Уравнения (2) можно преобразовать к виду: mL ф (t) ■ costp (.£) — -mL ф2Ш- sintp (Й = Я(Й, —т1ф(0 -sinipitj — тЬф'О:) • ■ CQStpit) = VT(iJ — mg.
(4)
Подставим уравнения (4) в уравнения (1) и выполним некоторые преобразования. В результате получим нелинейное дифференциальное уравнение, которое описывает поведение системы «обратный маятник, закрепленный на валу двигателя»:
где L'- эффективная длина маятника [10], которая рассчитывается по формуле:
J+mlT
mL
Задачу синтеза, которую необходимо решить для данного объекта, можно разделить на два этапа:
1. Раскачка маятника из положения устойчивого равновесия до приближения угла маятника к возможности стабилизации его в положении неустойчивого равновесия, при ограниченном управляющем воздействии.
2. Приведение угла отклонения маятника от вертикали к нулевому значению.
Формально задача синтеза для данного объекта, как для объекта с переменной структурой, записывается следующим образом:
(<р(0) = л => (p{i) = [—<р-,<р\ где <р = 5°
lim дай
= 0,
(6)
при выполнении требований по быстродействию к переходному процессу в системе
2. ИССЛЕДОВАНИЕ СВОЙСТВ СИСТЕМЫ ПО ЛИНЕАРИЗОВАННОЙ МОДЕЛИ
Перед выбором алгоритма стабилизации системы «обратный маятник» необходимо проверить, что задача синтеза в постановке (6) будет иметь решение.
Для этого необходимо перейти к линеаризованной модели объекта.
Допустим, что угол отклонения маятника от вертикали изменяется в диапазоне —5= < <р < 3°, и разложим в ряд
Тейлора с подстановкой только первого члена ряда разложения [11]:
Подставляя (7) в (5), получим линеаризованное дифференциальное уравнение, которое описывает поведение объекта управления в рабочей точке.
Перейдем к описанию модели объекта в переменных состояния. В качестве компонент вектора состояния выберем угол отклонения маятника от вертикали и его первую производную:
В результате уравнения состояния примут следующий вид:
(10)
Структурная схема объекта управления «обратный маятник», соответствующая системе уравнений (10), представлена на Рис. 2.
Рис. 2. Структурная схема системы «обратный маятник»
Найдем множество равновесных состояний системы, для чего приравняем производные правой части (10) к нулю.
(11)
Решив уравнения неизвестных, получим:
относительно
При управлении I' 0. для координат х1их2 точкой равновесия является 0.
Таким образом, для модели объекта (10) задача стабилизации угла маятника в 0 разрешима, т.к. это точка принадлежит к множеству равновесных состояний объекта [12].
Запишем матрицу А - собственных свойств, В - вектор управляюших воздействии и С -вектор выхода модели объекта (10):
Устойчивость системы можно определить по собственным числам матрицы А:
(13)
где р - оператор дифференцирования, I -единичная диагональная матрица 2*2.
Собственные числа принимают значения:
(14)
Объект неустойчив, т. к. одно из собственных чисел имеет положительную вещественную часть [12].
В условия разрешимости задачи синтеза также входят анализ управляемости и наблюдаемости объекта управления.
Из [12] известно, что «-мерный объект управляем тогда и только тогда, когда матрица управляемости:
:■ = г ,-.:_г . .-.'■--г (15)
имеет полный ранг. Так как объект одноканальный, то критерий управляемости принимает вид:
ЛвШ
.
Матрица управляемости объекта имеет вид:
(16)
Очевидно, что определитель матрицы и ненулевой, из этого следует, что объект является полностью управляемым.
Из [12] известно, что «-мерный объект наблюдаем тогда и только тогда, когда матрица наблюдаемости:
имеет полный ранг, одноканального объекта:
то
есть,
для
АЛЛ * О
Матрица наблюдаемости имеет следующий вид:
(18)
Очевидно, что определитель матрицы N ненулевой, из этого следует, что объект является полностью наблюдаемый.
Из исследования математической модели системы следует, что объект наблюдаем, управляем и имеет реализуемое состояние равновесия. Таким образом, задача синтеза является разрешимой, можно переходить к разработке алгоритмов раскачки и стабилизации.
3. РАЗРАБОТКА АЛГОРИТМОВ РАСКАЧКИ И СТАБИЛИЗАЦИИ МОДЕЛЬНОЙ СИСТЕМЫ «ОБРАТНЫЙ МАЯТНИК»
Т.к. в постановке задачи синтеза (5), угол отклонения маятника изменяется в диапазоне , предложен алгоритм раскачки маятника из устойчивого положения равновесия до диапазона углов, в котором возможна стабилизация в положении неустойчивого равновесия. Блок схема алгоритма раскачки представлена на Рис. 3.
Для решения второй части задачи, то есть для стабилизации маятника, предложено использовать метод синтеза, который обеспечивает заданную реакцию системы на начальные условия, то есть модальный метод [10, 12].
Описание объекта управления в переменных состояниях (10) преобразуем к виду:
(19)
Метод синтеза предполагает организацию следующего закона управления:
и = -Кх и =
,
(20)
где К - вектор коэффициентов регулятора, который нужно рассчитать.
Подставляя (20) в (19), получим описание замкнутой системы:
■. - = - - л- ■■- ■. - (21)
Таблица 1
Параметр Значение Единица измерения
т, масса маятника 0,05 кг
Ь, половина длины 0,05 м
маятника
g, ускорение силы 9,81 м/с2
тяжести
L', эффективная 0,054 м
длинна маятника
3, момент инерции 1.04 •Ю-6 кг • м
маятника
Рис. 3 Блок схема алгоритма раскачки «обратного маятника»
Рис. 4 Структурная схема замкнутой системы с регулятором
Рассчитанные параметры объекта и регулятора следующие:
Запишем характеристическое уравнение системы (21):
А (рО = р* — аг ^гР ~ +" = 0. (22)
По требованиям к качеству работы системы формируется желаемое уравнение:
Приравнивая коэффициенты при соответствующих степенях характеристического уравнения (22) и желаемого уравнения (23), получим соотношения для расчета параметров регулятора:
ЧИСЛЕННЫЙ ПРИМЕР РАСЧЕТА И РЕЗУЛЬТАТЫ МОДЕЛИРОВАНИЯ ЗАМКНУТОЙ СИСТЕМЫ
В Табл. 1 представлены численные значения объекта управления «обратный маятник».
Требование к качеству переходного процесса следующее:
.
На Рис. 4 представлена структурная схема замкнутой системы.
На Рис. 5 представлены переходные процессы в системе стабилизации при следующих начальных углах отклонения маятника от вертикали:
<Р(п = 0.122 рад; <рВ1 = 0.087 рад;
Риз = 0.052 рад;
а р
008 006 004 0.02
<Р01
\ —
\ \ \ \ _ <Р<* .................
—^ м
\ А \ А:
Рис. 5 Переходные процессы в системе с регулятором
На Рис. 6 представлены переходные процессы в системе стабилизации при следующих начальных углах отклонения маятника от вертикали:
й ft
/v /// /// / ч / ч / .. У... / гТ................. ^ Voi
! / ' / / / / / / / .__—~ f Ф02 ___$S|)3
Рис.6. Переходные процессы в системе с регулятором
ЗАКЛЮЧЕНИЕ
В данной статье была рассмотрена задача стабилизации модельной системы «обратный маятник, закрепленный на валу двигателя». Приведены нелинейные дифференциальные уравнения, описывающие динамику данного объекта, и сформулированы задачи синтеза. Осуществлен переход к линеаризованной модели, для которой проведен анализ ее качественных свойств. Предложен алгоритм раскачки обратного маятника из устойчивого положения в окрестность точки неустойчивого равновесия. Также предложен алгоритм стабилизации системы на основе модального метода синтеза. Приведены результаты моделирования замкнутой системы в среде MatLab Simulink, которые подтверждают, что в замкнутой системе с регулятором удается добиться процессов заданного качества.
В дальнейшей работе планируется разработать учебный стенд «обратный маятник, закрепленный на валу двигателя» на базе микроконтроллера Arduino Mega 2560.
ЛИТЕРАТУРА
[1] Формальский А.М. Управление движением неустойчивых объектов. М.: ФИЗМАТЛИТ, 2012. 232 с.
[2] Дружинина О.В. и др. Моделирование и построение алгоритма стабилизации перевернутого маятника. Динамика сложных систем -XXI век. 2012. № 4. с. 74-78.
[3] Саблина Г.В., Дроздова О.Н. Исследование и синтез системы «двойной перевернутый маятник на тележке». Матер. VIII международной н.-т. конференции «Актуальные проблемы электронного приборостроения (АПЭП)». Новосибирск, Изд-во НГТУ, 2006, Т7, с. 249-252.
[4] Nishida M., Kaneshide A., Terashima K. Control system of nonlinear process to swing up and stabilize inverted pendulum. Trans. of the Society of Instrument and Control Engineers, № 9, 1995, Vol. 31, p. 1452-1461.
[5] Андриевский Б.Р., Гузенко П.Ю., Фрадков А.Л. Управление нелинейными колебаниями
механических систем методом скоростного градиента. Автоматика и Телемеханика. М: Наука, 1996.
[6] Саблина Г.В. Разработка и исследование методики стабилизации объекта управления «каретка-маятник»: Автореф. дис. ... канд. техн. наук. - Новосибирск. 2000.
[7] Саблина Г.В., Сажин А.И. Исследование реального скользящего режима в модельной системе «перевернутый маятник». Автоматика и программная инжерения. 2015, №1(11), с. 9-15
[8] Hemani H., Golliday C. The inverted pendulum and biped stability. Math. Biosci, 34, 1977, p. 95-110.
[9] Kieffer J., Bale R. Walking viability and gain synthesis for novel class dynamically-simple biped walking machines. Informatica, 17, 1993, p. 145155.
[10] Квакернаак X., Сиван Р. Линейные оптимальные системы управления. М: Мир, 1977. 653 с.
[11] Бронштейн И.Н., Семендяев К.А. Справочник по матема-тике для инженеров и учащихся втузов. 13-е изд., исправленное. М.: Наука, 1986.
[12] Востриков А.С., Французова Г.А., Гаврилов Е.Б. Теория автоматического регулирования: Учеб. пособие. Новосибирск, Изд-во НГТУ, 2008. 476 с.
Г)
Эмирбеков Нурбек Эмирбекович,
магистрант каф. Автоматики НГТУ email: wolf 2011 @mail.ru
Эмирбеков Мирбек Эмирбекович,
магистрант каф. Автоматики НГТУ email: wolf 2011 @mail.ru
Design of swing and stabilization algorithms of the inverse pendulum fixed on a motor shaft
Nurbek Emirbekov, Mirbek Emirbekov
Abstract. In this paper, the task of swing and stabilization of the inverse pendulum fixed on a motor shaft is considered. The nonlinear differential equations describing this system behavior are given and transition to its linearized model is performed. The swing algorithm of the pendulum from stable position to area of a point of an unstable equilibrium is offered. The stabilization algorithm allowing to ensure demanded quality of transient in system is developed. Simulation of the closed system with the controller in Matlab Simulink program environment is spent.
Key words: inverse pendulum, swing, stabilization, controller.
REFERENCES
[1] Formal'skij A.M. Upravlenie dvizheniem neustojchivyh ob'ektov. M.: FIZMATLIT, 2012. 232 s.
[2] Druzhinina O.V. i dr. Modelirovanie i postroenie algoritma stabilizacii perevernutogo majatnika. Dinamika slozhnyh sistem -XXI vek. 2012. № 4. s. 74-78.
[3] Sablina G.V., Drozdova O.N. Issledovanie i sintez sistemy «dvojnoj perevernutyj majatnik na telezhke». Mater. VIII mezhdunarodnoj n.-t. konferencii «Aktual'nye problemy jelektronnogo priborostroenija (APJeP)». Novosibirsk, Izd-vo NGTU, 2006, T7, s. 249-252.
[4] Nishida M., Kaneshide A., Terashima K. Control system of nonlinear process to swing up and stabilize inverted pendulum. Trans. of the Society of Instrument and Control Engineers, № 9, 1995, Vol. 31, p. 1452-1461.
[5] Andrievskij B.R., Guzenko P.Ju., Fradkov A.L. Upravlenie nelinejnymi kolebanijami mehanicheskih sistem metodom skorostnogo gradienta. Avtomatika i Telemehanika. M: Nauka, 1996.
[6] Sablina G.V. Razrabotka i issledovanie metodiki stabilizacii ob#ekta upravlenija «karetka-majatnik»:
Avtoref. dis. ... kand. tehn. nauk. - Novosibirsk. 2000.
[7] Sablina G.V., Sazhin A.I. Issledovanie real'nogo skol'zjashhego rezhima v model'noj sisteme «perevernutyj majatnik». Avtomatika i programmnaja inzherenija. 2015, №1(11), s. 9-15
[8] Hemani H., Golliday C. The inverted pendulum and biped stability. Math. Biosci, 34, 1977, p. 95-110.
[9] Kieffer J., Bale R. Walking viability and gain synthesis for novel class dynamically-simple biped walking machines. Informatica, 17, 1993, p. 145155.
[10] Kvakernaak X., Sivan R. Linejnye optimal'nye sistemy upravlenija. M: Mir, 1977. 653 s.
[11] Bronshtejn I.N., Semendjaev K.A. Spravochnik po matema-tike dlja inzhenerov i uchashhihsja vtuzov.-13-e izd., ispravlennoe. - M.: Nauka, 1986.
[12] Vostrikov A.S., Francuzova G.A., Gavrilov E.B. Teorija avtomaticheskogo regulirovanija: Ucheb. posobie. Novosibirsk, Izd-vo NGTU, 2008. 476 s.