CC BY
93
СИСТЕМЫ УПРАВЛЕНИЯ
J
УДК 621.865:004.896
ИССЛЕДОВАНИЕ УСТОЙЧИВОСТИ СИСТЕМЫ УПРАВЛЕНИЯ ДВУРУКОГО МАНИПУЛЯЦИОННОГО РОБОТА
И.А. Калеватых, А.Г Лесков
МГТУ им. Н.Э. Баумана, Москва
e-mail: [email protected]; [email protected]
Рассмотрены вопросы устойчивости системы управления двурукого манипу-ляционного робота. Предложен метод исследования устойчивости двурукого манипуляционного робота как многомерной динамической системы на основе частотного критерия Найквиста. Приведены результаты аналитических исследований и расчетов динамики таких роботов при выполнении операций в свободном пространстве и при манипулировании объектами.
Ключевые слова: двурукие манипуляционные роботы, контактные операции, податливое движение, исследование устойчивости.
STABILITY ANALYSIS OF CONTROL SYSTEM OF TWO-MANIPULATOR COOPERATIVE SYSTEM
I.A. Kalevatykh, A.G. Leskov
Bauman Moscow State Technical University, Moscow e-mail: [email protected]; [email protected]
Problems of stability of control system of a two-manipulator cooperative system are considered. A method is proposed for analysis of stability of the two-manipulator cooperative system as a multidimensional dynamical system based on the Nyquist frequency criterion. The results of analytical studies and calculations of dynamics of these systems while they perform operations in the free space and manipulate objects are given.
Keywords: two-manipulator cooperative system, interaction tasks, compliant motion, stability analysis.
Двурукие манипуляционные роботы (МР) необходимы для решения широкого круга задач, таких как перенос крупногабаритных грузов или механическая сборка. При выполнении характерных для двуруких МР операций исполнительные механизмы рук МР часто образуют замкнутую кинематическую цепь. Свойства такой замкнутой системы резко отличаются от свойств одноруких МР при движении в свободном пространстве. В частности, система управления двурукого МР, устойчивая при отсутствии механической связи между руками, может оказаться неустойчивой при захвате объекта. В связи c этим актуальной является задача разработки методов анализа и обеспечения устойчивости системы управления двурукого МР на всех режимах работы, включая двурукое манипулирование объектами.
Вопросы динамики двуруких МР изучалась во многих работах [1-3]. Однако в них либо недостаточно полно учитывается динамика
приводов, либо задача сводится к одномерному случаю, что является довольно грубым приближением. В действительности МР — многомерная динамическая система. В работах [4-7] показано, что свойства МР как многомерной динамической системы существенно отличаются от свойств МР как системы отдельно взятых приводов (без учета динамического взаимовлияния [4]). При этом различие проявляется в таких важных аспектах, как устойчивость и качество динамических процессов. В работе [6] главное внимание уделено одноруким МР при выполнении операций в свободном пространстве.
В настоящей статье положения работ [5, 6] развиты в направлении исследования двуруких МР. Проведены исследования многомерной динамики двурукого МР при замыкании рук, применены частотные методы и предложена формулировка критерия Найквиста для определения устойчивости МР. Отдельно исследован случай применения коррекции сил и моментов реакции связи между замкнутыми руками. Приведены примеры исследований, выполненных этими методами, подтвержденные компьютерным моделированием.
Модель динамики МР. Систему уравнений движения однорукого
МР можно записать в векторно-матричной форме [5]:
А(д)д + b(q, д) + с(д) = -
(1)
N(Р)^д = Мм(рШ - д) - Щр)рд,
где д — вектор обобщенных координат шарниров; д* — вектор входных сигналов приводов; — вектор моментов, развиваемых приводами; — вектор внешних сил и моментов, приведенных к шарнирам; А(д) — матрица инерционных коэффициентов; Ь(д, д*) — вектор приведенных к шарнирам моментов от действия центробежных и кориолисовых сил; с(д) — вектор приведенных к шарнирам моментов от действия гравитационных сил (равен нулю в условиях невесомости); N(р), Мм(р), Мс(р) — матричные передаточные функции (ПФ), описывающие динамику приводов (элементы этих матриц — полиномы от р).
В дальнейшем будем рассматривать операции МР, при выполнении которых скорости движения малы и вектором центробежных и кориолисовых сил можно пренебречь, а коэффициенты уравнений (1) можно считать постоянными. Такими операциями являются распространенные на практике монтажные, сборочные работы и т.п. При выполнении именно таких операций МР часто находится в контакте со средой.
С учетом этого исполнительную систему МР, описываемую уравнениями (1) можно представить в виде структурной схемы (рис. 1). На рисунке обозначено: Шм(р) = N-1(р)Мм(р), Шс(р) = N-1(р)Мс(р) — матричные ПФ.
Рис. 1. Структурная схема исполнительной системы МР
Уравнения (1) можно представить в форме "вход-выход":
q(t) = W(p)q*(t) -
где
W (р) = {Ар2 + Wc(p)p + Wм(p)) Шм(р) (2)
— матричная ПФ исполнительной системы управления (ИСУ) МР по отношению к вектору входных управляющих воздействий;
Wв(p) = (Ар2 + Wc(p)p + Wм(p))-1 (3)
— матричная ПФ ИСУ МР по отношению к вектору возмущающих воздействий.
Устойчивость ИСУ МР при взаимодействии с неподвижным объектом. Исследуем устойчивость многомерной ИСУ однорукого МР при его взаимодействии с неподвижным объектом. Этот случай соответствует операциям, при выполнении которых один из манипуляторов двурукого МР неподвижен. Мы будем исследовать устойчивость при условии, что контакт уже установлен, не рассматривая процессы на границе свободной зоны. Структурная схема, соответствующая этому случаю, в линейном приближении представлена на рис. 2.
На схеме обозначено: х, хс — декартовы координаты рабочего органа МР и неподвижного объекта соответственно; f — вектор сил и моментов реакции в точке контакта; Л — матрица Якоби для соотношения х = Е(д); Сс(р) - матричная ПФ, определяющая свойства контакта между МР и объектом (модель среды).
Рис. 2. Структурная схема многомерной ИСУ МР при взаимодействии с неподвижным объектом
Точную модель среды обычно трудно получить в аналитической форме. Однако в большинстве практических случаев достаточно упрощенной линеаризованной модели окружения, принимающей во внимание только динамические эффекты [3]:
Gc(p) = Mcp2 + Dcp + Kc, (4)
где Mc, Dc, Kc — матрицы инерции, демпфирования и жесткости среды соответственно.
В работе [8] показано, что исследовать устойчивость многомерной замкнутой системы управления можно на основе рассмотрения функции Найквиста:
Q(p) = det H(p)/det H0(p) - 1,
где H0(p), H(p) — характеристические определители разомкнутой и замкнутой систем соответственно.
В нашем случае замыкание системы соответствует возникновению механического контакта.
Уравнения ИСУ МР до момента возникновения контакта имеют
вид
Ap2q = ^д - ^в;
N(p)^ = Мм(p)(q* - q) - Mc(p)pq, а ее характеристический определитель равен
A(p) = det {N(p)} • det {Ap2 + Wc(p)p + Шм^)} .
При возникновении механического контакта эти уравнения видоизменяются:
(Ap2 + J"GcJ) q = ^д - ^в;
N(pp)рд = Мм(p)(q* - q) - M^p)pq,
и характеристический определитель вновь образованной системы приобретает вид
ДкЬ) = det {N(p)} det {Ap2 + Wc(p)p + Wc(p) + JтGc(p)J} . Последнее соотношение можно преобразовать так:
Дк(p) = det {N(p)} det {Ap2 + Wc(p)p + Шм^)} x
x det{E + {Ap2 + Wc(p)p + Wм(p))-1 JтGc(p)J}
или
Дк(p) = Д(p) • det {E + {Ap2 + Wc(p)p + Wм(p))-l JтGс(p)J} .
Выражение для функции Найквиста в рассматриваемом случае принимает вид
Як(р) = Дк(р)/Д(р) - 1 =
= ае^Е + (Ар2 + Wc(p)p + Wм(p))"1 7та(р) л} - 1 или, что то же самое,
фк(р) = 7-1С-1(р)Сс(р) Л+
+ 7-1Сс-1(р)Сс(р)7 (Ар2 + Wc(p)p + Wм(p))-1 7тСс(р)л} - 1;
^к(р) = (ЦЕ + Сс(р)Л (Ар2 + Wc(p)p + Wм(p))-1 7т} х
х ае1 (7-1С-1(р)} • ае! |Сс(р)7} - 1.
С учетом обозначения (3) можно записать
фк(р) = (ЦЕ + а(р) 7 (Ар2 + Wc(p)p + Wм(p))-1 - 1 =
= ае! {Е + Сс(р)7 • Wв(p)Jт}- 1. (5)
Анализ устойчивости системы проводится после перехода в частотную область и состоит в рассмотрении расположения годографа функции фк(_;ш) при изменении частоты ш в пределах от -то до то относительно точки (-1,^'0) [8].
Если многомерная ИСУ МР асимптотически устойчива при движении в свободном пространстве, для ее устойчивости при контакте с неподвижным объектом необходимо и достаточно, чтобы годограф функции дк0'ш) при изменении ш от -то до то не охватывал точку
(-и 0).
В таком виде критерий устойчивости МР при взаимодействии с неподвижным объектом рассматривался в работе [6].
Устойчивость ИСУ двурукого МР при связанном движении.
Рассмотрим теперь устойчивость ИСУ двурукого МР в случае, когда его руки связаны, т.е. образуют замкнутую кинематическую цепь. Этот случай соответствует операциям сборки, переноса объектов двумя руками и др.
В линейном приближении структуру многомерной ИСУ двурукого МР при связанном движении можно представить в виде схемы, приведенной на рис. 3, а. На рисунке все обозначения ПФ и величин, относящихся к разным манипуляторам, имеют различные индексы. Другие обозначения: хХ - плановые координаты системы координат (СК), связанной с объектом (СК объекта), в декартовом пространстве.
Рис. 3. Структура ИСУ двурукого МР при связанном движении
Предполагается, что СК, которые определяют положение рук (СК рук) так позиционированы относительно их схватов, что при выполнении операции совпадают в пространстве с СК объекта; Ах — разница между положениями СК рук МР в декартовом пространстве; Сс(р) — матричная ПФ, определяющая свойства контакта между МР и объектом в виде (4) (ее параметры определены в СК объекта); /в — вектор возмущающих сил и моментов, действующих на захваченный объект.
В работе [6] предложено выражение для функции Найквиста, позволяющей исследовать устойчивость многомерной замкнутой системы управления, в виде
Q(p) = det {Е + Wv(p)}- 1, (6)
где Wр(p) — матричная ПФ разомкнутой системы.
Найдем ПФ разомкнутой системы управления двурукого МР при связанном движении. Для этого преобразуем схему (рис.3,а) к виду, приведенному на рис. 3, б. Можем записать ПФ разомкнутой системы
(место размыкания указано на рис.3, б) по отношению к возмущающему воздействию:
Wp(p) = f (*)Ш*) = а(р){ 71 (А1 р2 + ^1(р)р + Wмl(p))-1 7т+
+ 72 (А2р2 + Wc2(p)p + Wм2(p))-1 лт}.
Тогда выражение для функции Найквиста, позволяющей судить об устойчивости двурукого МР при связанном движении, примет вид
д2к(р) = ае*{ Е + Сс(р) ( 71(А1р2 + Wcl(p)p + Wмl(p))-17т+
+ 72(А2р2 + Wc2(p)p + Wм2(p))-1 тт) } - 1. Или с учетом обозначения (3)
д2к(р) = ае! {Е + Сс (71 • Wвl(p)7т + 72 • Wв2(p)^т)} - 1. (7)
Сравнивая выражения (5) и (7) можно заметить, что функция Най-квиста системы управления двурукого МР при связанном движении содержит сумму матричных ПФ разомкнутых систем управления отдельных рук, взаимодействующих с неподвижным объектом.
Сформулируем критерий устойчивости для связанного движения двурукого МР.
Если многомерные ИСУ рук двурукого МР асимптотически устойчивы при движении в свободном пространстве, для устойчивости его многомерной ИСУ при замыкании рук необходимо и достаточно, чтобы годограф функции ^2к(^ш) при изменении ш от -то до то не охватывал точку (-1, ]0).
В таком виде функция Найквиста и критерий устойчивости многомерной ИСУ двурукого МР получены впервые. Методика определения устойчивости многомерных ИСУ рук при движении в свободном пространстве приведена в [6].
Выражение (7) можно расширить и на случай нескольких взаимодействующих МР (^ > 1):
7 (Агр2 + Wcг(p)p + Wмг(p))-1 ¿т} - 1;
к(р) = ае! | Е + Сс(р)
На рис. 4 приведены результаты исследования многомерной ИСУ двурукого МР при связанном движении в частотной и временной областях при трех различных значениях жесткости захваченного объекта.
N
Qnк(р) = detl E + Gc(p) X]
i=1
N
- 1.
i=1
Рис. 4. Годографы функции Найквиста ИСУ двурукого МР и соответствующие им переходные процессы Ах в системе по одной из координат при варьировании жесткости захваченного объекта
На графике (а) представлены годографы функции Найквиста системы в виде (7), на графике (б) — увеличенное изображение окрестности точки (-1,30), на графике (в) — переходные процессы разности положений рук по одной из декартовых координат. Исследование полностью подтвердило правильность полученных выше результатов.
Устойчивость ИСУ двурукого МР при связанном движении с коррекцией сил и моментов реакции. На практике очень редко встречаются случаи, когда при операциях, выполняемых двумя руками МР, не нужно контролировать возникающие силы и моменты реакции связи. Погрешности, возникающие при движении каждой руки, могут привести к падению удерживаемого объекта (если он зажат между руками) или к значительным нагрузкам на руки и переносимый объект. Как правило, для коррекции сил и моментов реакции связи используют либо схемы пассивной податливости, когда на запястье МР крепится специальное компенсирующее устройство, например устройство с вынесенным центром податливости, либо схемы активной податливости, когда силы и моменты, действующие на запястье МР, измеряются силомоментным датчиком (СМД) для организации обратной силовой связи.
Рассмотрим устойчивость ИСУ двурукого МР в случае, когда его руки связаны и применяются методы для коррекции сил и моментов реакции. Для примера применим активный метод коррекции меха-
нической проводимости МР [3]. Под механической проводимостью понимаем зависимость между действующими на МР силами и моментами и его отклонением от желаемой траектории. Достоинство метода в том, что он может применяться к МР, оснащенным позиционной или скоростной системой управления. Блок коррекции механической проводимости работает во внешнем контуре силовой обратной связи, принимая на вход силы и моменты реакции связи и выдавая в канал позиционной системы управления рук МР корректировку плановой траектории. Его ПФ имеет вид
Сп(р)= (Мпр2 + £пр + Кп )-1, (8)
где матрицы Мп, Дп, Кп определяют целевую механическую проводимость МР.
Как правило, внешний контур силовой обратной связи работает на более низких частотах, чем внутренний контур позиционного управления. Это связано со временем опроса СМД, необходимостью выполнения расчетов и так далее. Многие исследователи [3] указывают на то, что запаздывание в контуре управления оказывает существенное влияние на качество процессов управления и может привести к неустойчивости системы. Для учета задержек при анализе можно модифицировать ПФ корректирующего устройства (8) следующим образом:
=«.(р)!-^, (9) где Т — постоянная времени запаздывания.
Структуру ИСУ двурукого МР для такого случая в линейном приближении можно представить в виде схемы, приведенной на рис. 5, а. Здесь предполагается, что на вход блока коррекции механической проводимости поступает достаточно точная оценка вектора сил и моментов реакции связи, которую обычно получают на основе данных СМД с помощью алгоритмической компенсации сил тяжести и инерции удерживаемого объекта.
На рис. 5, а обозначено: f * — плановый вектор сил и моментов с которыми МР должен воздействовать на объект. Он отличен от нуля, например, если объект зажат между руками и необходимо обеспечить заданную прижимную силу; Ах* — корректирующее отклонение от плановой траектории.
Выражение для функции Найквиста системы в этом случае, как и выше, будем искать в виде (6). Для этого преобразуем структурную схему (рис.5,а) к виду, изображенному на рис.5,б. Можем записать ПФ разомкнутой системы (место размыкания указано на рис. 5, б) по отношению к возмущающему воздействию:
Рис. 5. Структура ИСУ двурукого МР при связанном движении с коррекцией сил и моментов реакции
Wp (р) = / =
2
= Ос(р) ^ Зг (Агр2 + Wci(p)p + Wмг(p))-1 З/ (Е + З?WM1(p) J-1) ,
г=1
или с учетом обозначений (2) и (3)
2 ( )
Wp(p) = Ос (р) ^ (Зг WBг(p)З¡ + Зг Wl(p) З-1 Оп (р)) .
г=1
Тогда выражение для функции Найквиста, позволяющей судить об устойчивости ИСУ двурукого МР при податливом связанном движении (с блоком коррекции сил и моментов реакции связи) в зависимости от устойчивости ИСУ рук МР в свободном пространстве, примет вид
^к(р) = ¿е! |Е + Ос(р) ^ + №(р)^О^р))^ - 1.
г=1 ' (10)
Из выражения (10) следует, что применение механизма коррекции сил и моментов реакции связи может привести к неустойчивости ИСУ двурукого МР. Причем запасы устойчивости снижаются при повышении жесткости удерживаемого объекта. Это полностью соответствует экспериментальным результатам, представленным в предыдущей работе авторов [9].
Исследование годографа функции Найквиста (10) в частотной области позволяет обоснованно выбрать коэффициенты корректирующего устройства (8), обеспечивающие заданные запасы устойчивости системы.
Выражение (10) также можно расширить и на случай нескольких взаимодействующих МР (Ы > 1):
N
Qnк(р) = det\ E + Gc(p) ^ (JiWm(p)J + JiWi(p)J~1Gn(p))
- 1.
i=l
На рис. 6 приведены результаты исследования многомерной ИСУ двурукого МР при податливом связанном движении в частотной и временной областях при трех различных значениях постоянной времени запаздывания Т корректирующего устройства (9). На графике (а)
Рис. 6. Годографы функции Найквиста ИСУ двурукого МР и соответствующие им переходные процессы Ах в системе по одной из координат при варьировании постоянной времени запаздывания корректирующего устройства
представлены годографы функции Найквиста системы в виде (10), на графике (б) — увеличенное изображение окрестности точки (—1, j0), на графике (б) — переходные процессы разности положений рук по одной из декартовых координат. Исследование полностью подтвердило правильность полученных выше результатов.
Заключение. Предложенный в работе метод исследования устойчивости ИСУ двурукого МР как многомерной динамической системы позволил получить для таких систем выражения функций Найквиста при различных режимах работы и сформулировать частотные критерии устойчивости. Рассмотрены случаи работы МР при замыкании рук, в том числе при применении методов активной коррекции сил и моментов реакции. Полученные результаты подтверждены с помощью компьютерного моделирования и серии проведенных ранее экспериментов.
СПИСОК ЛИТЕРАТУРЫ
1. WenJ. T., Kreutz-Delgado K. Motion and force control of multiple robotic manipulators, Automatica 28 (4). - 1992. - P. 729-743.
2. CaccavaleF., Chiacchio P., Chiaverini S. Stability analysis of a joint space control law for a two manipulator system // IEEE Trans. Autom. Contr. 44. - 1999. - P. 85-88.
3. Vukobratovic M., Surdilovic D., Ekalo Yu. Dynamics and Robust Control of Robot-Environment Interaction, 2009. - 638 c.
4. Медведев В. С., Лесков А. Г., Ющенко А. С. Системы управления манипуляционных роботов. - М.: Наука, 1978. -416 c.
5. Лесков А. Г., Ющенко А. С. Моделирование и анализ робототехнических систем. - М.: Машиностроение, 1992. - 78 c.
6. Казмиренко В. Ф., Лесков А. Г., Введенский В. А. Системы следящих приводов. - М.: Энергоатомиздат, 1993. - 304 c.
7. З е н к е в и ч С. Л., Ющенко А. С. Основы управления манипуляционными роботами. - М.: Изд-во МГТУ им. Н.Э. Баумана, 2004. - 480 c.
8. РойтенбергЯ. Н. Автоматическое управление. - М.: Наука, 1976. - 396 с.
9. Л е с к о в А. Г., Калеватых И. А. Экспериментальные исследования алгоритмов управления связанным движением двурукого манипуляционного робота // Вестник МГТУ им. Н.Э. Баумана. Сер. Приборостроение. - 2012. - № 4. -C 33-43
Статья поступила в редакцию 22.11.2012
Игорь Алексеевич Калеватых — аспирант кафедры "Специальная робототехника и мехатроника" МГТУ им. Н.Э. Баумана. Специализируется в области исследования алгоритмов управления манипуляционными роботами при выполнении контактных операций.
I.A. Kalevatykh — post-graduate of "Special Robotics and Mechatronics" department of the Bauman Moscow State Technical University. Specializes in the field of study of algorithms to control manipulator systems for accomplishing the interactive tasks. Алексей Григорьевич Лесков — д-р техн. наук, профессор кафедры "Специальная робототехника и мехатроника" МГТУ им. Н.Э. Баумана, директор Дмитровского филиала МГТУ им. Н.Э. Баумана. Автор более 70 научных работ в области робототехники.
A.G. Leskov — D. Sc. (Eng.), professor of "Special Robotics and Mechatronics" department of the Bauman Moscow State Technical University. Author of more than 70 publications in the field of robotics.
