Моделирование движения трехзвенного робота с безредукторным приводом с использованием робастных регуляторов

Расчет и конструирование

машин

УДК 681.5.03

Моделирование движения трехзвенного робота с безредукторным приводом с использованием робастных регуляторов

Т.А. Макарова

При решении многих современных технических задач удобно представлять объект в виде интервальной системы дифференциальных уравнений. Для работы с такими системами необходимы робастные алгоритмы стабилизации. В данном исследовании представлен пример разработки регулятора, основанного на алгоритме стабилизации интервальных квадратичных систем методом форм. Эта разработка является одним из вариантов динамического управления манипуляторами. Задача такого управления актуальна при проектировании роботов с традиционными приводами в случае больших масс и/или скоростей, а также роботов с более перспективным с современной точки зрения безредукторным приводом в связи с взаимовлиянием степеней подвижности. В статье приведено математическое преобразование уравнений динамики робота к интервальному виду; дано подробное описание математической модели регулятора, использующего векторные обратные связи тактического уровня. Для доказательства эффективности такого вида стабилизации проведено компьютерное моделирование движения трехзвенного стержневого робота с использованием регулятора, что выявило существенное уменьшение динамической ошибки. Робастный регулятор может быть использован как часть общей системы управления роботами.

Ключевые слова: взаимовлияние степеней подвижности, регулятор, без-редукторный привод, манипулятор, моделирование, робастный алгоритм.

МАКАРОВА Татьяна Александровна

MAKAROVA Tat'yana Aleksandrovna

(Moscow, Russian Federation,

Moscow State University of Technology «STANKIN»)

Simulation of motion of a three-link robot with a gearless drive using robust regulators

T.A. Makarova

Many modern technological problems can be described by interval systems of differential equations. To solve these systems, robust stabilization algorithms are required. In this paper, an approach for developing a regulator on the basis of the algorithm for stabilizing interval quadratic systems by the method of forms is presented. This problem of dynamic control of manipulators is relevant in the design of robots with conventional drives in the case of large masses and/or velocity, as well as robots with more advanced gearless drives taking into account interactions of axes. The mathematical transformation of robot dynamics equations to an interval form is given and the mathematical model of a regulator using vector tactical level feedbacks is described in detail. The efficiency of stabilization is proved by the computer simulation of motion of a three-link robot with a regulator. The results showed a significant reduction in dynamic error. A robust regulator can be used as part of a general robot control system.

Keywords: interaction of axes, regulator, gearless drive, manipulator, modeling, robust algorithm.

I I ромышленный робот с последовательной кинематической структурой представляет собой многосвязную систему. Применение редукторов позволяет рассматривать ее в составе сепаратных приводов, что обеспечивает достаточность использования скалярных по координатам обратных связей исполнительного уровня.

Одним из перспективных направлений робототехники является применение безредук-торных электроприводов (direct drive), благодаря отсутствию в них упругого люфта механической передачи. Однако в этом случае очень существенно взаимовлияние степеней подвижности робота, причем с увеличением скоростей движения оно ощутимо возрастает [1—4]. Следует отметить, что повышение уровня взаимо-

влияния является существенным фактором и для роботов, использующих электродвигатели с редуктором в случае больших масс и скоростей, например, крупных манипуляторов космического базирования.

При построении исполнительной многосвязной системы безредукторного типа особое значение приобретает тактический уровень управления и векторные обратные связи, для синтеза которых необходима разработка специальных алгоритмов [5—7]. Динамическая компенсация с помощью обратных связей по силам и моментам рассмотрена в работах [3, 8]. Другая постановка задачи — отказ от использования специальных силомоментных измерителей и вычисление динамической коррекции на основе обратных связей по скоростям и положению.

В качестве примера многосвязной системы рассмотрим трехзвенный робот с вращательными степенями подвижности (рис. 1). Для упрощения математической модели звенья робота аппроксимированы стержнями длиной ^ и массой т,, груз в схвате представлен точечной массой т0 [9, 10]. В качестве уравнений динамики манипулятора использованы уравнения Лагранжа 2-го рода. Все расчеты и моделирование проведем для следующих параметров:

mi, кг .............................................................................. 15

«2, кг .............................................................................. 10

ОТ3, кг ...............................................................................6

ото, кг ............................................................................ 1,5

11, м ..............................................................................0,4

12, м ..............................................................................0,5

13, м ..............................................................................0,5

В качестве программной траектории выберем окружность в плоскости с наклоном а к плоскости О0х010, по которой эффектор робота движется равномерно. Параметры окружности

представлены ниже:

Координаты центра

окружности

Координаты начальной точки

движения ..................................................

Радиус окружности г, м ................................. 0,1

Рис. 1. Схема трехзвенного робота с вращательными степенями подвижности и траектория движения

Уравнения для задания окружности: х = г ) + х0; у = г ео8(ю? )8т а + у 0; г = —г еоз(ю? )ео8 а +г0,

где а = 30°, ю = 4 рад/с.

Цель вычислительного эксперимента — исследовать движение робота при моментном управлении в условиях нескомпенсированного взаимовлияния приводов и определить эффективность использования робастных регуляторов.

Модель трехзвенного робота для вычислительного эксперимента. Модель робота создана в среде 81шиИпк МАТЬДБ. Ее общая схема представлена на рис. 2.

Блок трехзвенного робота описывается известными уравнениями динамики стержневого робота рассматриваемой кинематической схемы.

Рис. 2. Общая схема модели: Пр1—Пр3 — приводы

Определение задающего момента представляет собой решение второй задачи динамики манипулятора в программном движении.

Запишем уравнения динамики в форме Ла-гранжа 2-го рода в общем виде [3]:

а11^1 + + 2ЬШ^3 + dl = ц 1;

a 22 Я-2 + a 2з^'з + b2iiüi + 2bmq2q3 +

+b233 Í32 + d2 = Ц 2;

a 32 q2 + a 33q3 + b311 q\ + b322 qj + d 3 = ц 3

где ц1—ц3 — обобщенные моменты; а9, Ьт, di —

функциональные коэффициенты, зависящие от массогабаритных показателей и обобщен-

ных координат, например

b311 =

2 m3 + mo

lj3 sin( q2 + ^3) +

+ 0,5

3 m3 + mo

l32 sin(2q2 + 2q3) +

+

- m3 + mo

l2l3 cosq2 sin( q2 + q3).

Приведем систему (1) к нормальной форме Коши:

qt = u¡, i = 1,2,3;

U1 ;

l5 '

«3 u 6;

U4 = w 2u4 u 5 + w 3u4 u 6 + w^ 1; «5 = w 6 + w 7«42 + w 8u 52 + w 9u2 +

+ w10u 5u 6 + w4 ц 2 + w 5ц 3;

22 u6 = w13 + w14 u4 + w15u 5 + w16u,

+ w17u5u6 + 2 + w1^ 3.

Здесь wt — функции от массогабаритных показателей и обобщенных координат, например,

1 m3 + mo ]/3 + (0,5m3 + mo )/2 cosq

33

1

3 m2 + m3 + mo

m3 + mo ll2 13 -

-(0,5m3 + mo)212213 cos2 q3 ].

При моделировании используются уравнения ПЗК и ОЗК трехзвенного робота:

х = -sinq1[l3 cos(q2 + q3) +12 cosq2 +11],

y = cosq1[l3 cos

2

г = 13 sin(q 2 + q 3) +l2 sin q 2;

х

q1 = -arctg

У'

q2 = arcsin[х2 + y2 + г2 +12 - 21,4х2 + y2 +

+l2 -1з2] /[2l2 Vх2 + y2 + г2 +12 - 21,4х2 + У2 ]

4х2 + y2 - А

—arctg -

z

q 3 = arccos(x2 + y2 + z2 + l]2 — 122 — 132 —

— 2i,4x2 + у2 )/(2l2l3).

Динамика приводов в эксперименте не учитывалась. Приводы были представлены идеальным источником момента.

Математическая модель стабилизатора. В работе [3] отмечено, что наиболее радикальным способом борьбы с взаимовлиянием каналов является формирование управляющих моментов в виде суммы собственно управляющих моментов и корректирующих моментных воздействий, но это возможно лишь для моментных приводов.

Систему, параметры которой заданы не «в точке», а в некоторых интервалах, называют интервальной. В настоящее время интенсивно разрабатываются методы интервального анализа, используемые, в том числе, в робототехнике при построении робастных алгоритмов управления.

Рассмотрим объект с возмущенным движением, описываемый квадратичной системой дифференциальных уравнений в форме Коши с линейной частью:

m m m

ю, = ХХ v

i=1 k=1 j=1 V '

ы = colon(ro1...юm ), i = 1,...,m,

где ю, — возмущенные переменные; фt (•) — некоторые функции этих переменных с векторными параметрами; p; — функции управления (стабилизатор); t — время; Х v (t), уk)(t) —

коэффициенты. Точные значения этих коэффициентов неизвестны, но известны их постоянные интервалы:

Х

Х mm Х j \l / — ' max ' у mm — у kj У1 ' — у max '

которые представим в следующем виде:

х = ( Xij) Х( )V v('') =( v( k) V1

xij \х min' х max/; Г kj \ I min , (

,

Задачей управления объектом является ликвидация его возмущенного состояния, под которым понимается любое отклонение от программного движения. Алгоритм поиска стабилизатора с постоянными параметрами для данного объекта из условия асимптотической устойчивости по Ляпунову тривиального решения системы (5) представлен в работе [11]. Программа, реализующая этот алгоритм в пакете MATLAB, автором настоящей статьи названа «Поиск» и подробно рассмотрена в работе [12].

Вариацией системы (2) получим систему уравнений в возмущениях: yi = х,; У 2 = х 2; y 3 = х з;

х, =

+(2w9u 6 + w10u 5)х 3 + w7 х 12 + w8 х 2 +

+~9 х 32 + w10 х 2 х 3 + w4 Ац 2 + w5 Ац 3; х 3 = 2~14 u4 х 1 + (2w15u 5 + w17u 6)х 2 + +(2w16u 6 + w17u 5)х 3 + ~14 х 12 + ~15 х 2 + +~16 х З2 + w17 х 2 х 3 + ~12 Ац 2 + w11 Ац 3,

где wt — коэффициенты, учитывающие возмущения обобщенных координат.

Поскольку обобщенные координаты входят в состав коэффициентов wt как аргументы тригонометрических функций, были найдены абсолютные значения минимума и максимума каждого коэффициента, т. е. была реализована возможность представления их в виде интервала. Для полной численной записи системы были использованы значения скоростей для программного режима движения.

Из анализа системы (7) следует, что в первые три уравнения не входят управляющие воздействия. Система является не полностью замкнутой. Для последних трех уравнений системы с помощью алгоритма «Поиск» можно добиться асимптотической устойчивости в части переменных х(?), т. е. limх(?) = 0. Так как y(t) являются первообразными для х^), то получим lim y(t) = const, причем значение константы определяется начальными условиями. В терминах

работы [13] это означает, что в части переменных у^ ) можно добиться у-устойчивости решения, а в части переменных х(?) — у-притяже-ния. Кроме того, из сравнения системы (7) и (5) следует, что вектору стабилизатора необходимо поставить в соответствие выражения управляющих воздействий:

~ Ац 1 = Ф1;

~4 Ац 2 + ~5 Ац 3 = ф 2;

~12 АЦ 2 + ~11 АЦ 3 = ф 3.

С учетом сказанного выше, для системы (7) получим интервальную систему следующего вида:

у1 = х1;

у 2 = х 2 ;

у 3 = х 3;

Х1 =( §1) Х1 +( Я 2} х 2 +( § 3}х 3 +(§4) х 1х 2 +

+

x 2 = \ g s)x 1 +\ g 1/x 2 + \ g 0 x 3 +\ g 9)x 1 +

+( gl<>) X 22 +( gll) X 32 +( gu) X 2 X 3 + Ф 2; X 3 = ( gn)X1 + (gl4 )X 2 + fel5 )X 3 + (gl6 )X l2 + +gll) X 22 + ( gl%) X 32 +(gl<>) X 2 X 3 + Ф 3.

где gt — интервальные коэффициенты, зависящие от массогабаритных показателей робота и предельных значений скоростей на программной траектории.

Рассмотрим численный пример системы (9) с учетом значений, принятых для моделирования параметров,

У = Xl;

у 2 = X 2 ;

у 3 = X 3;

X = (—10.4, l0.4)Xl +(-26, 26)x2 +(—9.l, 9.l)X3 +

+(-2, 2)xxX2 +(—0.1, O.I)xlX3 +Ф1 ;

X2 =

+(—2, 2)xf +(—0.8, 0.8)x22 +—05, 0.5)x32 +

+—09, 0.9)x2x3 +ф2 ;

X3 =(—lll, 11l)xl +(—25.8,25.8)x2 +

+(—8.8, 8.8)x3 +(—4.5, 45)x* +—25, 25)x22 +

+(— 0.8, 0.8)x32 +(—1.6, l.6)x2x3 +ф3.

Применив программу «Поиск» [12], получим вектор стабилизатора:

—ф1 =148,4х 1 +13,6х 2 + 9,6х 3 + 6,1х 1 +

+ 2,1х1 х 2 + 4,8х 1 х 32 + 2,8х 2 х 32;

—ф 2 =13,6х 1 + 96,3х 2 + 8,7х 3 + 6,1х 23 +

+ 2,12х 2 х 2 + 5,9х 2 х 32 + 2,8х 1 х 32;

—ф 3 = 9,6х 1 + 8,7х 2 +109,1х 3 + 6,1х 33 +

+ 4,8х 12 х 3 + 5,9х 2 х 3 + 2,8х 1 х 2 х 3.

Поскольку в системе (8) при приращениях программных моментов стоят коэффициенты, которые можно представить в виде интервалов, то уравнения для вычисления стабилизирующих моментов имеют вид

Wl) Лц l = Ф1;

w4)Aц 2 + (WsW 3 = Ф 2;

wu) Лц 2 +(wll) Лц 3 = Ф 3-

Существование и единственность решения линейных интервальных систем рассмотрено в работе [14]. Используем упрощенное решение, найденное для средних точек интервалов коэффициентов:

Лц 1 = 8,14Ф1 ;

Лц 2 = 3,58Ф 2 + 0,88Ф 3;

Лц 3 = 0,88Ф 2 + 0,81Ф 3.

Применимость такого подхода в данном случае будет доказана в ходе эксперимента, в котором полученный регулятор с постоянными коэффициентами обратных связей по скоростям будет использоваться для стабилизации системы (2) с непрерывно изменяющимися параметрами в соответствии с заданным движением.

Результаты вычислительного эксперимента. Во

время эксперимента сравнивалось движение эффектора робота по окружности в соответствии с рис. 1 без стабилизатора и с ним. Траектории, полученные графики с помощью инструмента Simulink XY Graph, представлены на рис. 3.

При отработке программного движения на скорость второй степени подвижности манипу-

•Уокр. М" 0,20,1 -

о--0,1 -0,2-0,2-0,1 0 0,1 0,2*О1ф, м -0,2 -0,1 0 0,1 0,2 *оч>.м

а б

Рис. 3. Отработка траектории:

а — без стабилизатора; б — со стабилизатором; ^ — направление движения; ^ — время подачи импульса

лятора в момент времени 0,35 с был искусственно подан возмущающий импульс длительностью 0,01 с и величиной 20% максимального значения скорости на данной траектории. Схема без стабилизатора, очевидно, теряет устойчивость из-за отсутствия обратных связей и быстрого накопления ошибок (рис. 3, а). При использовании стабилизатора заданная траектория отрабатывается полностью (рис. 3, б).

Выводы

1. Многосвязная исполнительная система на основе безредукторных приводов требует стабилизации движения на основе векторных обратных связей тактического уровня.

2. Для построения стабилизатора можно использовать алгоритм, представленный в работе [11], позволяющий существенно уменьшить динамическую ошибку стабилизированного движения по нескольким координатам взаимовлияния.

3. Описанный стабилизатор может быть использован как часть общей системы управления роботом. При рассмотрении динамики привода он может быть дополнен регуляторами со скоростными и/или позиционными обратными связями, исходя из заданного качества движения.

Литература

[1] Илюхин Ю.В. Управление исполнительными системами лазерных технологических комплексов с упругими механическими передачами. Депон. в ВИНИТИ. Москва, МГТУ «СТАНКИН». 1997, № 413-В97. 27 с.

[2] Макаров И.М., Лохин В.М., ред. Интеллектуальные системы автоматического управления. Москва, ФИЗМАТЛИТ, 2001. 576 с.

[3] Зенкевич С.Л., Ющенко А.С. Основы управления мани-пуляционными роботами. Москва, Изд-во МГТУ им. Н.Э. Баумана, 2004. 480 с.

[4] Макарова Т.А., Стебулянин М.М. Оценка взаимовлияния движения степеней подвижности трехзвенного робота с безредукторными приводами. Вестник МГТУ «Стан-кин», 2012, № 3 (22), с. 149—154.

[5] Илюхин Ю.В. Совершенствование систем управления механообрабатывающих технологических роботов на основе концепций мехатроники. Мехатроника, 2001, № 2, с. 7-13.

[6] Willems J.C., Takaba K. Dissipativity and stability of interconnections. Int. J. of Robust & Nonlinear Control, 2007, vol. 17, issue 5—6, pp. 563—586.

[7] Willems J.C. On interconnections, control and feedback. IEEE Transactions on Automatic Control, 1997, vol. 42, pp. 326—339.

[8] Вукобратович М., Стокич Д., Кирчански Н. Неадаптивное и адаптивное управление манипуляционными роботами. Москва, Мир, 1989. 376 с.

[9] Егоров О.Д. Механика и конструирование роботов. Москва, Изд-во Станкин, 1997. 510 с.

[10] Егоров О.Д., Подураев Ю.В. Конструирование меха-тронных модулей. Москва, МГТУ «СТАНКИН», 2004. 360 с.

[11] Стебулянин М.М. Алгоритм асимптотической стабилизации в целом интервальных квадратичных систем с неограниченным управлением. Мехатроника, автоматизация, управление, 2010, № 5, с. 7—13.

[12] Стебулянин М.М., Макарова Т.А. Метод форм при асимптотической стабилизации решений интервальных квадратичных систем. Современное состояние естественных и технических наук. Материалы VII Междунар. науч.-практ. конф. Москва, 2012, с. 9—15.

[13] Румянцев В.В., Озиранер А.С. Устойчивость и стабилизация движения по отношению к части переменных. Москва, Наука, гл. ред. физ.-мат. лит., 1987. 256 с.

[14] Лакеев А.В. Существование и единственность алгебраических решений интервальных линейных систем в полной арифметике Каухера. Вычислительные технологии, 1999, т. 4, № 4, с. 33—44.

References

[1] Iliukhin Iu.V. Upravlenie ispolnitel'nymi sistemami lazernykh tekhologicheskikh kompleksov s uprugimi mekhanicheskimi peredachami [Management of executive systems, laser processing systems with elastic mechanical transmissions]. Moscow State University of Technology «STANKIN» publ., Depon. VINITI, 1997, no. 413-V97, 27 p.

[2] Intellektual'nye sistemy avtomaticheskogo upravleniia [Intelligent automatic control system]. Ed. Makarov I.M., Lokhin V.M. Moscow, FIZMATLIT publ., 2001. 576 p.

[3] Zenkevich S.L., Iushchenko A.S. Osnovy upravleniia manipuliatsionnymi robotami [Management Basics robotic manipulator]. Moscow, Bauman Press, 2004. 480 p.

[4] Makarova T.A., Stebulianin M.M. Otsenka vzaimovliianiia dvizheniia stepenei podvizhnosti trekhzvennogo robota s bezreduktornymi privodami [Evaluation of interference of movement degrees of mobility three-link robot with gearless drives]. Vestnik MGTU«Stankin» [Bulletin of Moscow State University of Technology «STANKIN»]. 2012, no. 3 (22), pp. 149—154.

[5] Iliukhin Iu.V. Sovershenstvovanie sistem upravleniia mekhanoobrabatyvaiushchikh tekhnologicheskikh robotov na osnove kontseptsii mekhatroniki [Improving the management systems of machining technology of robots based on the concepts of mechatronics]. Mekhatronika [Mechatronics]. 2001, no. 2, pp. 7-13.

МАШИНОСТРОЕНИ

[6] Willems J.C., Takaba K. Dissipativity and stability of interconnections. International Journal of Robust and Nonlinear Control, 2007, vol. 17, issue 5—6, pp. 563—586.

[7] Willems J.C. On interconnections, control and feedback. IEEE Transactions on Automatic Control, 1997, vol. 42, pp. 326—339.

[8] Vukobratovich M., Stokich D., Kirchanski N. Neadaptivnoe i adaptivnoe upravlenie manipuliatsionnymi robotami [Non-adaptive and adaptive control of robotic manipulator]. Moscow, Mirpubl., 1989. 376 p.

[9] Egorov O.D. Mekhanika i konstruirovanie robotov [Mechanics and design of robots]. Moscow, Moscow State University of Technology «STANKIN» publ., 1997. 510 p.

[10] Egorov O.D., Poduraev Iu.V. Konstruirovanie mekhatronnykh modulei [Designing mechatronic modules]. Moscow, Moscow State University of Technology «STANKIN» publ., 2004. 360 p.

[11] Stebulianin M.M. Algoritm asimptoticheskoi stabilizatsii v tselom interval'nykh kvadratichnykh sistem s neogranichennym upravleniem [Algorithm of Asymptotic General Stabilization of Iinterval Quadratic Systems with Unlimited Control]. MAU [Mechatronics, automation, management]. 2010, no. 5, pp. 7—13.

[12] Stebulianin M.M., MakarovaT.A. Metodformpri asimptoticheskoi stabilizatsii reshenii interval'nykh kvadratichnykh system [Stability and stabilization of motion with respect to the variables]. Sovremennoe sostoianie estestvennykh i tekhnicheskikh nauk. Materialy 7 Mezhdunarodnoi nauchno-prakticheskoi konferentsii [The current state of the natural and technical sciences. Proceedings of the 7th International Scientific and Practical Conference]. Moscow, 2012, pp. 9—15.

[13] Rumiantsev V.V., Oziraner A.S. Ustoichivost' i stabilizatsiia dvizheniia po otnosheniiu k chasti peremennykh [Stability and stabilization of motion with respect to part of the variables]. Moscow, Nauka publ., 1987. 256 p.

[14] Lakeev A.V. Sushchestvovanie i edinstvennost' algebraicheskikh reshenii interval'nykh lineinykh sistem v polnoi arifmetike Kaukhera [Existence and uniqueness of algebraic solutions to interval linear systems in Kaucher complete interval arithmetic]. Vychislitel'nye tekhnologii [Computational Technologies]. 1999, vol. 4, no. 4, pp. 33—44.

Статья поступила в редакцию 28.08.2013

Информация об авторе

МАКАРОВА Татьяна Александровна (Москва) — соискатель степени канд. техн. наук кафедры «Робототехника и мехатро-ника». МГТУ «СТАНКИН» (121055, Москва, Российская Федерация, Вадковский переулок, д. 3а, e-mail: upnk@stankin.ru).

Information about the author

MAKAROVA Tat'yana Aleksandrovna (Moscow) — Candidate for a Degree, «Robotics and Mechatronics» Department. Moscow State University of Technology «STANKIN» (STANKIN, Vadkovskiy pereulok, 3a, 121055, Moscow, Russian Federation, e-mail: upnk@stankin.ru).