Научная статья на тему 'Управление двухзвенным манипулятором с использованием нечеткого управления скользящего типа'

Управление двухзвенным манипулятором с использованием нечеткого управления скользящего типа Текст научной статьи по специальности «Математика»

CC BY
484
92
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
АДАПТИВНОЕ УПРАВЛЕНИЕ / НЕЧЕТКОЕ УПРАВЛЕНИЕ / СКОЛЬЗЯЩИЕ РЕЖИМЫ / НЕЛИНЕЙНЫЕ СИСТЕМЫ / ADAPTIVE CONTROL / FUZZY CONTROL / SLIDING MODE / NONLINEAR SYSTEMS

Аннотация научной статьи по математике, автор научной работы — Забихифар С.Х., Маркази А.Х.Д., Ющенко А.С.

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

i Надоели баннеры? Вы всегда можете отключить рекламу.
iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

TWO LINK MANIPULATOR CONTROL USING FUZZY SLIDING MODE APPROACH

In solving a number of complex manipulating problems, it is desirable to use the fuzzy logic which reproduces the human-operator’s experience. Controlling large space-based manipulators and ground handling systems used both in constructionand post-accident cleaning-up can be considered such problems. However, the control of these manipulation systems becomes complicated due to sophisticated and nonlinear structure dynamics, which cannot be fully described.That the control rules are independent from a mathematical model of an object is the advantage of using the fuzzy logic for solving these problems. Nevertheless, as the complexity of the object dynamics grows, the number of such rules increases significantly. In this context, a new approach has recently been developed. It is based on the sliding mode application, which in its turn is generated by a fuzzy controller. The study of this approach seems important for controlling the manipulator with a significant dynamic unit interaction. The paper describes an adaptive control method using a sliding mode based on the fuzzy approach. The method enables the system to withstand external disturbances. Its implementation does not require awareness of the system dynamic model

Текст научной работы на тему «Управление двухзвенным манипулятором с использованием нечеткого управления скользящего типа»

АВТОМАТИЗАЦИЯ И УПРАВЛЕНИЕ ТЕХНОЛОГИЧЕСКИМИ ПРОЦЕССАМИ И ПРОИЗВОДСТВАМИ

DOI: 10.18698/0236-3933-2015-6-30-45 УДК 621.865

УПРАВЛЕНИЕ ДВУХЗВЕННЫМ МАНИПУЛЯТОРОМ С ИСПОЛЬЗОВАНИЕМ НЕЧЕТКОГО УПРАВЛЕНИЯ СКОЛЬЗЯЩЕГО ТИПА

С.Х. Забихифар1, А.Х.Д. Маркази2, А.С. Ющенко1

ХМГТУ им. Н.Э. Баумана, Москва, Российская Федерация e-mail: zabihifar.iust@yahoo.com; yusch@bmstu.ru

2Иранский университет Науки и Технологий, Тегеран, Иран e-mail: markazi@iust.ac.ir

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

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

TWO LINK MANIPULATOR CONTROL USING FUZZY SLIDING MODE APPROACH

S.H. Zabikhifar1, A.H.D. Markazi2, A.S. Yuschenko1

1Bauman Moscow State Technical University, Moscow, Russian Federation e-mail: zabihifar.iust@yahoo.com; yusch@bmstu.ru

2Iran University of Science and Technology e-mail: markazi@iust.ac.ir

In solving a number of complex manipulating problems, it is desirable to use the fuzzy logic which reproduces the human-operator's experience. Controlling large space-based manipulators and ground handling systems used both in construction

and post-accident cleaning-up can be considered such problems. However, the control of these manipulation systems becomes complicated due to sophisticated and nonlinear structure dynamics, which cannot be fully described.That the control rules are independent from a mathematical model of an object is the advantage of using the fuzzy logic for solving these problems. Nevertheless, as the complexity of the object dynamics grows, the number of such rules increases significantly. In this context, a new approach has recently been developed. It is based on the sliding mode application, which in its turn is generated by a fuzzy controller. The study of this approach seems important for controlling the manipulator with a significant dynamic unit interaction. The paper describes an adaptive control method using a sliding mode based on the fuzzy approach. The method enables the system to withstand external disturbances. Its implementation does not require awareness of the system dynamic model.

Keywords: adaptive control, fuzzy control, sliding mode, nonlinear systems.

Большая часть методов управления нелинейными системами предполагает достаточно точное описание объекта управления. В последнее время разрабатываются методы, позволяющие управлять нелинейными системами с неполным математическим описанием. Хорошо известный подход к управлению с помощью скользящих режимов является одним из методов, позволяющих управлять нелинейными системами с неопределенностью [1, 2]. Недостатком традиционных скользящих режимов является появление "дребезга" в цепи входного сигнала в тех случаях, когда область неопределенности недостаточно мала. Высокочастотная составляющая сигнала, возникающая за счет переключений в окрестности поверхности скольжения, может повредить систему управления двигателями и даже привести к неустойчивости всей системы.

Управление с использованием методов нечеткой логики является альтернативным подходом, также позволяющим обойтись без точного знания математической модели управляемого объекта и справляться с внешними возмущениями [3,4]. Однако методы нечеткого управления пока не позволяют на систематической основе формировать продукционные правила, обеспечивающие устойчивость замкнутой системы управления.

Для того чтобы сочетать преимущества каждого из перечисленных методов, т.е. скользящих режимов и нечеткой логики, разрабатываются новые методы, комбинирующие тем или иным способом эти подходы [5,6]. Их основная тенденция — справиться с неопределенностью математической модели и, по возможности, устранить "дребезг" переключений. Один из таких гибридных методов управления получил название "Адаптивное нечеткое скользящее управление" (Adaptive Fuzzy Sliding-mode Control (AFSMC). Этот метод показывает хорошие результаты в применении к системам с высоким уровнем неопределенности [7, 8]. Метод предусматривает систематическое формирование нечетких продукционных правил и при выполнении определен-

ных условий обеспечивает асимптотическую устойчивость замкнутой системы управления [9].

Метод AFSMC успешно применялся для задач управления нелинейными системами управления различных типов [10, 11]. Представляется возможным и его применение в робототехнике для задачи управления манипулятором в условиях, когда математическое описание динамики манипулятора известно неполностью.

Постановка задачи. Рассмотрим класс MIMO аффинных нелинейных систем, описываемых дифференциальными уравнениями следующего вида:

Г (ri) 1 y( ) " fi(x) '

= +

y(rm) ym /m(x)

gil

0 0

0

0

0

0

gmm

u1

(1)

Запишем эту систему дифференциальных уравнений более компактно:

y(l) = F (x) + Gu, (2)

где y = [yi,..., ym]T и yr = [yl1,..., ym]T — вектор выходных сигналов и их производных. Вектор состояний x = [y1 ,y/1,...,y(l1 1), ..., ym, ym,..., ymm 1)]T предполагается наблюдаемым. Здесь обозначено также u = [u1,... , um]T — вектор сигналов управления, F(x) = = [f1(x),..., fm(x)]T — вектор неизвестной функции x, G = = diag [g11... gmm] — неизвестная диагональная матрица с постоянными элементами и r = [r1,..., rm]T, причем степень рассматриваемой системы равна r1 + r2 + ... + rm = n.

При наличии дополнительной аддитивной неопределенности в правой части системы (2) ее описание может быть модифицировано следующим образом:

y(r) = F (x) + Gu + d, (3)

где d = [d1,..., dm]T — вектор сосредоточенных неопределенностей, которые, как предполагается, ограничены, т.е. |d»| <

Рассмотрим желаемую траекторию вектора yd = [yd1,...,ydm]T. Ошибку отработки этой траектории определим как

y = yd- y. (4)

Теперь задача состоит в том, чтобы определить закон управления, т.е. выбрать вектор u таким, чтобы ошибка y сходилась к нулю асимптотически.

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

При этом звенья будем считать стержнями, а шарниры отнесем к идеальным кинематическим парам 5-го класса. Предположим вначале, что все элементы gii(i = 1,... , m) в уравнении (1) не нулевые. Это предположение будет в дальнейшем ослаблено.

Разработка скользящего режима управления включает в себя два этапа: первый шаг состоит в определении скользящей поверхности s(x), которая описывает "желаемую" — идеализированную динамику системы, которая является значительно более простой по сравнению с реальной. Второй шаг заключается в разработке системы управления с переменной структурой, в которой сигнал управления u обеспечивает достижение поверхности скольжения за конечное время при любых начальных условиях. На скользящей поверхности выполняется скользящий режим, соответствующий динамике идеализированной системы. Тем самым обеспечивается устойчивость траектории на поверхности скольжения s(x).

Определим m поверхностей скольжения как

S = CY = [sb...,sm]T , (5)

где Si = Cjyi и Ci = [ci1,..., Oi(n_i), 1]T — вектор коэффициентов Гур-вица, а Y = [yi,..., y1)]T — вектор ошибки слежения с элементами

yi = ydi - yi

. (6)

yiri-1) = ydri-1) - Vl- i = 1,... ,m.

Дифференцируя по времени уравнение поверхности скольжения, получаем

c-iYi ^У] Ajj

ч? y

j=i ri-1

- E (Aijyj) + y(ri) =

ri-l , ■) < \ < \ = E (Aijyj) + y™ - y(ri) = j=1

- E + 7/(п) 7/(п) -- EXi + ydi - yi -

,(ri)

- EXi + ydii) - fi(x) - gnUi - di,

где обозначено

ri-l

(j

Ем = £ (Кз3 . (8)

3 = 1

Закон управления в скользящем режиме определяется как [5]

и = + иг, (9)

где "эквивалентный" закон управления ие<1 определяется из условия

s = 0, т.е.

§г = ел + y™- /г(х) - = o

- = (¿) (е*+уГ - /(*)> (10)

"Робастный закон управления" игЬ используется для преодоления неопределенности системы, обеспечивая конечное время достижения поверхности скольжения:

игЬ = С-1 V. (11)

Здесь

т

V = ^гй^П^в^) ^ V = [Asgn(S)] , (12)

sgn(S) = ..., sgn(sm)]T.

Отсюда следует с учетом (7)

¿г = Едг + - /г (X - £ггИг - ¿г = = ЕАг + - /г(х) - 2гг М* + <*) - ¿г = (13)

= ЕАг + - /г(х) - (Чг + - /г(X + - ¿г = = -¿г - V» = -¿г - ^п(^).

Для исследования устойчивости выберем функцию Ляпунова как

Ьг = 2 ¿2, (14)

её производная по времени в силу системы (13) равна

Ьг = ¿г¿г = -¿А, - |вг| ^г < ^гМ^г 1 - |вг| ^г = /1г\

= -|вг | № -К |) < 0. ( )

Таким образом, управление в скользящем режиме (9) обеспечивает устойчивость системы (2) по Ляпунову.

Предлагаемый контроллер AFSMC. Целью сочетания нечеткого управления и скользящего режима является использование нечеткой логики для того, чтобы представить управление и как нелинейную функцию скользящей поверхности [11]. Контроллер, обеспечивающий нечеткий скользящий режим контроллера, — это нечеткий логический контроллер, входными сигналами которого служат параметры скользящей поверхности или их производные. Выходными сигналами контроллера являются сигналы управления и. Если параметры системы (1) точно известны, то управление можно определить как и* = ие^. Но на практике трудно получить точную модель системы. Поэтому для того, чтобы аппроксимировать идеальный контроллер и*, применяются методы нечеткой логики.

Рассмотрим нечеткую систему Такаги - Сугено с одним входом , определяющим поверхность скольжения к-й подсистемы во введенной

/иг г»

ранее системе, и одним выходом и'к . Зададим пг нечетких продукционных правил в следующем виде.

Правило г. Если вк есть Лгк, то и{,иг = Ьгк, г = 1,...,пг, где Ьк — это нечеткий синглтон для выходной переменной г-го правила и Лгк — нечеткое множество, которое характеризуется гауссовой функцией принадлежности

2"

ßAk (sk) = exp

sk - ck

а

k

(16)

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

»(sk )

fuz Ut =

r=1

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

nr

z

r=1

(17)

(sk)

Определяя силу г-го правила как

№ (вк)

V

wu =

nr

Z

r=1

r = 1,..., nr,

(18)

№ (sk)

выходную переменную нечеткой системы можно записать в виде

U

fuz

(19)

ьк \вк,Ьк) = ЬкШк,

где Шк = К,...,ш-]Т, Ьк = [Ьк,...,ЬП]Т.

В том случае, когда известна точная математическая модель системы, вектор выходных координат нечеткого контроллера для системы с т входами Б = ..., вт]Т и т выходами и{иг,..., и/^ обозначается как

Ufuz* =

и1 (вЪ Ь1), . . . , ит (sm, Ьт)

и "идеальное" управление может быть определено как

"(Б, В*) + 2 = ) + Е

т

u* = Ufuz*

(20)

(21)

где W = K...,wJ\B =[b1,...,bm]

IT

= [£ъ. . . ,^m]T — это

ошибка аппроксимации или неопределенность, которая по предположению ограничена: |£к| < кк

На практике оптимальный вектор параметров Ьк, а также границы неопределенности К = [к1,..., кт] могут быть неизвестны. Обозна-

a

чая оценку это неопределенной границы как K, определяем погрешность оценки

K(t) = K— К (t). (22)

Выход нечеткой системы, аппроксимирующей идеальный контроллер, можно переписать следующим образом:

к/uz к КТ

u k (sk, b k )= b fc W, k = 1, 2,...,m, (23)

где b k — это оценка bk. Таким образом, закон управления может быть представлен как

Uk =К Г* (sk, b k )+ ukb(sk ), k = 1, 2,..., m. (24)

Здесь составляющая ukb используется для того, чтобы компенсировать разницу между нечетким и идеальным контроллером. Подставляя (24) в (1), получаем

= F(x) + G [К/uz +urbj . (25)

Определяя ошибки аппроксимации как

U/uz = м*_ К/uz, B = B*_ К (26)

и учитывая (21), (23) и (26), получаем

u/uz = diag(B TW ) + S. (27)

Основное положение теории управления AFSM можно сформулировать следующим образом.

Теорема. Пусть в системе (1) с законом управления (24) нечеткий контроллер настраивается по закону адаптации

B = -B = aiW diag(S ). (28)

Робастный контроллер формируется как

urb = diag(K)sgn(G)sgn(S (t)), (29)

оценка величины границы неопределенности адаптивно настраивается в соответствии с выражением

K = _K = «2Sgn(G) |S(t)| , (30)

где a1 и а2 — предварительно выбранные положительные параметры, определяющие скорость адаптации. Тогда ошибка слежения асимптотически стремится к нулю.

Доказательство. Выберем функцию Ляпунова в виде

т

V = £ ^к;

к=1 1 1 - - 1 (31)

Ук(вк, Ьк, Кк) = -вк + -— дккЬ]:Ьк + -— дкк(«к)(«к).

2 2а1 2а2

Дифференцируя (31) по времени, с учетом (27), (28), (29) и (30), можно записать:

Ук (вк ,Ьк ,Кк) =

= вк вк +--|дкк | Ь^ Ь к +--|дкк | («к )(« к) =

а1 а2 1. 1

= sk gkk

b% wk + Ck - uk +--|gkk | bTbk +--|gkk | («k)(kk) =

a1 a2

= |gkk | bTf sk wk sgn(gkk) + —) +sk gkk (Ck - urkb)+— | gkk | (Kk )(K k) =

V a^ a2

= sk gkk Ck - sk gkk K k sgn(gkk )sgn(sk)--|gkk | (Kk )«2 |sk | =

«2

= sk gkk Ck - 1 sk 1 \gkk 1 (yK k + Kkj = sk gkk Ck - |sk 1 |gkk 1 (Kk ) = = sk gkk Ck - |sfc| \gkk \ (Kk) < (\sk \ \gkk \ Ck - \sk \ \gkk \ (Kk)) = = - (\sk\ \gkk\ (Kk - \Ck\)) < 0.

(32)

Определим функцию

m

т = 1^(\вкИдиI (Ф -1СкI)) <-У. (33)

г=1

Интегрируя обе части этого уравнения по времени, получаем

t

Г(т)dT < V(S(0), B, Ф) - V(S(t), B, Ф), (34)

о

где величина V(S(0),В,Ф) ограничена, а функция V(S(t),B, Ф), по крайней мере, не возрастает, поэтому

t

J Г(т)dT < то. (35)

о

Поскольку функция V неположительна и учитывая тот факт, что абсолютные значения функций в (33) равномерно непрерывны, можно сделать заключение (с учетом леммы Барбалата), что

lim r(t) = 0. (36)

Таким образом, при t ^ то скользящая поверхность S(t) ^ 0 равно-

vy

Рис. 1. Кинематическая схема двух-звенного манипулятора

fay) мерна, и, следовательно, гарантируется асимптотическая устойчивость решения. ^ Динамическая модель мани-

пулятора. Для того чтобы проде-^^^ монстрировать целесообразность

предлагаемого в предыдущем раз-Í 01 деле подхода, методика AFSMC

применилась для системы управления двухзвенным манипулятором. Кинематическая схема манипулятора показана на рис. 1. Стержневые звенья манипулятора имеют длину L и L2. Массы звеньев обозначены через M1 и M2. Пусть 01 и 02 обозначают относительные углы поворота (см. рис. 1).

Значения координат конечной точки первого звена

x1 = L1 cos 01,, y1 = L1 sin 01.

Аналогично, для второго звена

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

x2 = L1 cos 01 + L2 cos(01 + 02);

У2 = L1 sin 01 + L2 sin(01 + 02).

Относительные углы поворота ограничены соотношениями

п

0 < 01 < 2; -П < 02 < 0.

(37)

(38)

(39)

(40)

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

Значения углов относительного поворота 01 и 02, в свою очередь, могут быть получены путем решения обратной задачи кинематики. Из

уравнений (38), (39) нетрудно найти: ^ cos 02 =

K = L1 + L2 cos 02;

K2 = L2 sin 02;

x2 + у2

L 2

L2

2Li L2

^ 01 = arctg(x) - arctg(^.

/ -2

Используя уравнения Лагранжа и Эйлера - Лагранжа, получаем уравнения динамики двухзвенного манипулятора [11]:

1(М1 + М2)Ь101 + М2¿1 ¿202 еой(01 - 02)+

+М2¿1 ¿202 вт(01 - 02) + (М1 + М2сов 01 = Т^; (41)

Рис.2. Координаты конечной точки кинематической цепи манипулятора для всех комбинаций углов в\ и в2

M2L2202 + M2L1L20! cos(0i - 02)-

-M2LiL202 sin(0i - 02) + M2gL2 cos 02 = To2. (42)

Здесь Т#1, Tq2 — управляющие моменты двигателей степеней подвижности манипулятора.

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

¿1 = 01, ¿2 = 01, ¿3 = 02, ¿4 = 02. (43)

Дифференцируя их по времени, получаем

¿1 = ¿2, ¿2 = 01, ¿3 = ¿4, ¿4 = 02; (44)

¿2 = ( -M2L1 ¿2 sin(z1 - ¿3) cos(z1 - ¿3) + M2g cos ¿3 cos(z1 - ¿3)-

T T \

-M2L2¿4 sin(¿l - ¿3) - (M1 + M2)g cos ¿1 + + X

L1 L1 L2

\ -1 2-

x (Li (Mi + M2) - M2Li cos2 (zi - Z3)) ; (45)

¿¿4 = |^M2L2¿4 sin(¿l -¿3)cos^1 - ¿3) + (M1 + M2)g cos ¿1 cos^1 -¿3) +

TT

+(M1 + M2)L1 ¿2 sin^ - ¿3) - (M1 + M2)g cos ¿3 - —1 + —^ X

L1 M2 L2 /

X^L2 (M1 + M2) - M2L2 cos2 (¿1 - ¿3)) 1. (46)

Поскольку система имеет две степени свободы, нужно определить параметры Л11, Л21, а1, а2, для каждого из контроллеров степеней по-

Sliding Surface

Рис. 3. Функции принадлежности для поверхности скольжения

движности. Для того чтобы получить удовлетворительные переходные процессы в каждой степени подвижности можно воспользоваться средствами пакета МЛТЬЛБ 81шиНпк. Получены следующие значения параметров для 1-го и 2-го звеньев: Ли = 0,0629 и 0,0640; Л21 = 0,0246 и 0,0224; а1 = 10000 и 1000; а2 = -3000 и -300 соответственно.

Поверхности скольжения получены с использованием выбранных коэффициентов Л11 ,Л21 в соответствии с уравнением (5). Контроллер вычисляет управление по формуле (24) с нечеткой составляющей (23) и с использованием закона адаптации (28). Робастное управление формируется по формуле (29) с учетом настройки по формуле (30). Выбранные функции принадлежности для входных переменных, определяющих поверхности скольжения £ = ,в2]Т, показаны на рис. 3.

Начальные условия для функций принадлежности выходных координат: Ъ(0) = [-0,5, -0,25, 0, 0,25, 0,5]Т, г = 1, 2.

Начальные условия для границ неопределенности следующие:

ф(0) = 0,1, г = 1, 2.

Результаты моделирования. В этом разделе с использованием пакета 81МиЬШК оцениваются возможности алгоритма ЛБ8МС для управления двухзвенным манипулятором. Для моделирования движения манипулятора использовались инструменты 81тМесЬатс8. Схема моделирования приведена на рис. 4.

Размеры первого звена по связанным с ним осям X, У и Z составляют 0,03 м, 0,5 м и 0,03 м соответственно (средняя плотность 800 кг/м3); то же для второго звена — 0,03 м, 0,25 м и 0,03 м соответственно (средняя плотность 400 кг/м3).

В качестве входных сигналов при моделировании использовались законы изменения желаемых координат ХУ конечной точки манипулятора в диапазоне достижимости (рис. 5).

Эти сигналы соответствуют движению манипулятора по двум прямым с одной общей точкой (рис. 6).

tz> tz> z;

o->

UJ

ЧО

S3

-1

H

s

s

Я

U и

s g

p

0

01 4

Я

s

СП

о

о о н ч

0

О)

1 X

Dr

Я

AFSMC L1

Position

Velocity

Т ¡п

Connl

brth

1,

Bodyl

Signal Builde

— ►

□г

AFSMC LZ

brth

Earth

th2

"Пп

th2_dot

v.

Сопп1

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

V

3

Ш

Bod\C

I_

XY Graph

Рис. 4. Схема моделирования робота и управляющих устройств в пакете Симулинк

ы о

о\

_I_I_I_I_I_I_I_I_I_

О 1 2 3 4 5 6 7 8 9 t, с

Рис. 5. Входные сигналы относительно осей X и У

Решая обратную кинематическую задачу, получают желаемые законы изменения относительных углов поворота вх и в2. При использовании алгоритма управления ЛБ8М требуется найти реальные законы изменения этих углов и сравнить их с желаемыми. Результаты моделирования приведены на рис. 6. На рис. 7 показано изменение управляющих сигналов для первого и второго каналов управления.

Результаты моделирования показывают, что система управления достаточно точно отрабатывает заданную траекторию. Однако пока мы не рассматривали влияние изменения нагрузки.

О 123456789 t, с 0 123456789 t, с

в

Рис. 6. Результаты моделирования движения по осям X (а) и У (б), а также в плоскости ХУ (в):

1, 2 — желаемое и фактическое изменение координат

Рис. 7. Управляющий сигнал для первого (а) и второго (б) приводов

Для того чтобы исследовать влияние изменения нагрузки на процесс управления, было проведено моделирование при тех же условиях, но с полезной нагрузкой 500 г. Результаты моделирования на плоскости ХУ и сигналы управления показаны на рис. 8, 9. Отметим, что система практически инвариантна к изменению полезной нагрузки. Благодаря использованию нечеткой логики при реализации скользящих режимов

отсутствуют колебательные процессы в окрестности поверхности скольжения ("дребезг" реле).

Заключение. Предложенный алгоритм управления манипулятором ЛБ8М может быть реализован в качестве нелинейного контроллера и позволяет решить две проблемы, которые возникают при управлении нелинейными системами. Во-первых, теперь можно управлять объектом с неполностью известной математической моделью.

Рис. 8. Результаты моделирования на плоскости ХУ с полезной нагрузкой

Рис. 9. Управляющий сигнал для первого (а) и второго (б) приводов при наличии полезной нагрузки

Во-вторых, система приобретает робастность — инвариантность к возмущениям, благодаря тому, что она способна адаптироваться к различным ситуациям. Сочетание скользящих режимов с нечетким управлением позволяет избежать "дребезга" реле в окрестности поверхности скольжения. Таким образом, рассматриваемый метод может оказаться полезным и достаточно легко реализуемым для широкого класса технических систем, работающих в условиях неопределенности.

ЛИТЕРАТУРА

1. Rong-Jong Wai, Chih-Min Lin. Adaptive fuzzy sliding-mode control for electrical servo drive // Fuzzy Sets and Systems. 2004. Vol. 143. Р. 295-310.

2. Ishingame A., Furukawa T., Kawamoto S. and Taniguchi T. Sliding Mode Controller Design Based on Fuzzy Inference for Nonlinear Systems // IEEE Trans. Ind. Electro. 1993. Feb. Vol. 40. Р. 64-70.

3. Roopaei M., Zolghadri Jahromi M. Chattering-Free Fuzzy Sliding Mode Control in MIMO Uncertain Systems // Nonlinear Analysis. 2009. Nov. Vol. 71. Р. 4430-4437.

4. Lin C.M., Chen T.Y., Fan W.Z., Lee Y.F. Adaptive Fuzzy Sliding Mode Control for a Two-Link Robot // IEEE Int. Conf. Robotics and Biomimetics. 2005. Р. 581-586.

5. Poursamad A., Markazi A.H.D. Adaptive Fuzzy Sliding Mode Control for Multi-Input Multi-Output Chaotic Systems // Chaos, Solitons and Fractals. 2009. Dec. Vol. 42. No. 5. Р. 3100-3109.

6. Qiao F., Zhu Q., Winfield A., Melhuish C. Adaptive Sliding Mode Control for MIMO Nonlinear Systems Based on Fuzzy Logic Scheme // International Journal of Automation and Computing. 2004. July. Vol. 1. Р. 51-62.

7. Haghighi H.S., Davaie-Markazi A.H.D. Chaos prediction and control in MEMS resonators // Communications in Nonlinear Science and Numerical Simulation. 2010. Vol. 15. No. 10. Р. 3091-3099.

8. Bai Y. , Li P. Adaptive fuzzy sliding mode control for electro-hydraulic position servo system // Proceedings of 2010 Chinese Control and Decision Conference. 2010. Р. 3249-3253.

9. Wang J., Wang C., FengB., Sun Y, Liu J. Robust adaptive fuzzy sliding mode control of PM synchronous servo motor // Proceedings of 2010 Chinese Control and Decision Conference. 2010. Р. 3419-3422.

10. Liu S., Ding L. Robust Application of adaptive fuzzy sliding mode controller in PMSM servo system // Proceedings of 2010 International Conference on Computing, Control and Industrial Engineering. 2010. Vol. 2. Р. 95-98.

11. Baccouch M. A two-link manipulator: simulation and control design. University of Nebraska at Omaha, 2012.

REFERENCES

[1] Rong-JongWai, Chih-Min Lin. Adaptive fuzzy sliding-mode control for electrical servo drive. Fuzzy Sets and Systems, 2004, vol. 143, pp. 295-310.

[2] Ishingame A., Furukawa T., Kawamoto S., Taniguchi T. Sliding Mode Controller Design Based on Fuzzy Inference for Nonlinear Systems. IEEE Trans. Ind. Electro, 1993, Feb., vol. 40, pp. 64-70.

[3] Roopaei M., Zolghadri Jahromi M. Chattering-Free Fuzzy Sliding Mode Control in MIMO Uncertain Systems. Nonlinear Analysis, 2009, Nov., vol. 71, pp. 4430-4437.

[4] Lin C.M., Chen T.Y., Fan W.Z., Lee Y.F. Adaptive Fuzzy Sliding Mode Control for a Two-Link Robot. IEEE Int. Conf. Robotics and Biomimetics, 2005, pp. 581-586.

[5] Poursamad A., Markazi A.H.D. Adaptive Fuzzy Sliding Mode Control for Multi-Input Multi-Output Chaotic Systems. Chaos, Solitons and Fractals, 2009, Dec., vol. 42, no. 5, pp. 3100-3109.

[6] Qiao F., Zhu, Q., Winfield A., Melhuish C. Adaptive Sliding Mode Control for MIMO Nonlinear Systems Based on Fuzzy Logic Scheme. International J. of Automation and Computing, 2004, July, vol. 1, pp. 51-62.

[7] Haghighi H.S., Davaie-Markazi A.H.D. Chaos prediction and control in MEMS resonators. Communications in Nonlinear Science and Numerical Simulation, 2010, vol. 15, no. 10, pp. 3091-3099.

[8] Bai Y., Li P. Adaptive fuzzy sliding mode control for electro-hydraulic position servo system. Proc. of 2010 Chinese Control and Decision Conf., 2010, pp. 3249-3253.

[9] Wang J., Wang C., Feng B., Sun Y., Liu J. Robust adaptive fuzzy sliding mode control of PM synchronous servo motor. Proc. of 2010 Chinese Control and Decision Conf., 2010, pp. 3419-3422.

[10] Liu S., Ding L. Robust Application of adaptive fuzzy sliding mode controller in PMSM servo system. Proc. of 2010 International Conf. on Computing, Control and Industrial Engineering, 2010, vol. 2, pp. 95-98.

[11] Baccouch M. A two-link manipulator: simulation and control design. University of Nebraska at Omaha, 2012.

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

Забихифар Сейед Хасан — аспирант кафедры "Робототехнические системы и ме-хатроника" МГТУ им. Н.Э. Баумана.

МГТУ им. Н.Э. Баумана, Российская Федерация, 105005, Москва, 2-я Бауманская ул., д. 5.

Zabikhifar S.H. — Ph.D. student, Department of Robotic Systems and Mechatronics, Bauman Moscow State Technical University.

Bauman Moscow State Technical University, 2-ya Baumanskaya ul. 5, Moscow, 105005 Russian Federation.

Маркази Амир Хосейн Даваи — профессор кафедры "Машиностроение" Иранского университета Науки и Технологий.

Иранский университет Науки и Технологий, Тегеран, Иран.

Professor of Engineering, Department of Mechanical Engineering, Iran University of Science and Technology, Tehran, Iran.

Ющенко Аркадий Семeнович — д-р техн. наук, профессор кафедры "Робототехнические системы и мехатроника" МГТУ им. Н.Э. Баумана.

МГТУ им. Н.Э. Баумана, Российская Федерация, 105005, Москва, 2-я Бауманская ул., д. 5.

Yuschenko A.S. — D.Sc. (Eng.), Professor, Department of Robotic Systems and Mechatronics, Bauman Moscow State Technical University.

Bauman Moscow State Technical University, 2-ya Baumanskaya ul. 5, Moscow, 105005 Russian Federation.

Просьба ссылаться на эту статью следующим образом:

Забихифар С.Х., Маркази А.Х.Д., Ющенко А.С. Управление двухзвенным манипулятором с использованием нечеткого управления скользящего типа // Вестник МГТУ им.Н.Э.Баумана. Сер. Приборостроение. 2015. № 6. C. 30-45.

Please cite this article in English as:

Zabikhifar S.H., Markazi A.H.D., Yuschenko A.S. Two link manipulator control using fuzzy sliding mode approach. Vestn. Mosk. Gos. Tekh. Univ. im. N.E. Baumana, Priborostr. [Herald of the Bauman Moscow State Tech. Univ., Instrum. Eng.], 2015, no. 6, pp. 30-45.

i Надоели баннеры? Вы всегда можете отключить рекламу.