Научная статья на тему 'Расчет сил контактного взаимодействия между деформируемым объектом и звеньями захватного устройства манипулятора'

Расчет сил контактного взаимодействия между деформируемым объектом и звеньями захватного устройства манипулятора Текст научной статьи по специальности «Физика»

CC BY
270
36
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ЗАХВАТ / ДЕФОРМИРУЕМЫЙ ОБЪЕКТ / DEFORMABLE OBJECT / МОДЕЛИРОВАНИЕ / SIMULATION / АВТОМАТИЧЕСКИЙ ЗАХВАТ ОБЪЕКТОВ / AUTOMATIC OBJECT GRASPING / СИЛЫ КОНТАКТНОГО ВЗАИМОДЕЙСТВИЯ / CONTACT FORCES / ПЛАНИРОВАНИЕ ЗАХВАТА / GRASP PLANNING / ЗАХВАТНОЕ УСТРОЙСТВО SCHUNK WSG50 / SCHUNK WSG50 / GRASP

Аннотация научной статьи по физике, автор научной работы — Лесков А. Г., Селиверстова Е. В.

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

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

Похожие темы научных работ по физике , автор научной работы — Лесков А. Г., Селиверстова Е. В.

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

Computing Contact Forces Between a Deformable Object and Gripper Links of a Manipulator

We analysed the methods of computing contact forces between gripper links of a manipulator and a deformable object of manipulation. This problem is important for grasp simulation and planning. We present an original method for determining contact forces between objects, whose surfaces are modelled using point-based discretisation. We provide a solution to the Signorini problem based on the laws of linear elasticity theory and the Amonton —Coulomb model of friction. To compute the intersections of the object and gripper surfaces, we used an algorithm described in our previous works that takes into account the direction of the gripper link motion relative to the object. Advantages of the method proposed are low computational complexity and ease of implementation. We developed computer software and present experimental results that prove the efficiency of the algorithm

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

УДК 621.865:004.021

DOI: 10.18698/0236-3941-2018-3-58-74

РАСЧЕТ СИЛ КОНТАКТНОГО ВЗАИМОДЕИСТВИЯ МЕЖДУ ДЕФОРМИРУЕМЫМ ОБЪЕКТОМ И ЗВЕНЬЯМИ ЗАХВАТНОГО УСТРОЙСТВА манипулятора

А.Г. Лесков1

Е.В. Селиверстова1' 2

[email protected] [email protected]

1 Дмитровский филиал МГТУ им. Н.Э. Баумана, пос. Орево, Дмитровский р-н, Московская обл., Российская Федерация

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

Аннотация

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

Ключевые слова

Захват, деформируемый объект, моделирование, автоматический захват объектов, силы контактного взаимодействия, планирование захвата, захватное устройство Schunk WSG50

Поступила в редакцию 21.10.2017 © МГТУ им. Н.Э. Баумана, 2018

В настоящее время прослеживается устойчивая тенденция перехода к роботизированным технологиям в различных областях деятельности человека. Робототех-нические системы предоставляют возможность выполнять манипуляционную задачу с объектом без непосредственного нахождения человека в операционной зоне. Наиболее распространенной манипуляционной операцией является захват объекта.

Одним из способов синтеза захвата является офлайн-планирование по геометрическим моделям захватного устройства манипулятора (ЗУМ) и объекта манипулирования (ОМ) [1], выполняющее предварительную оценку возможных способов захвата. Для каждого способа конфигурации ЗУМ рассчитываются силы контактного взаимодействия (СКВ) между звеньями ЗУМ и ОМ, при

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

Первым этапом расчета СКВ является определение областей пересечения поверхностей ЗУМ и деформируемого ОМ при моделировании захвата. Результат работы алгоритма определения пересечений — это расчет сближения или глубины проникания [2] как расстояния, на которое звенья захватного устройства продвинулись в ОМ, если бы поверхность объекта не оказывала сопротивления. Проникание является условным и в действительности отсутствует. Для устранения такого проникания необходимо решить задачу Синьорини [3] — определить локальные деформации объекта и звена, как если бы они прикоснулись без пересечения, и силы, вызванные этой деформацией.

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

Методы «пенальти» и «штрафа» [5-7] наиболее широко используются для решения описанной задачи в компьютерной графике. Однако такие алгоритмы не могут полностью исключить пересечение поверхностей объектов. В [8] описан метод, сводящийся к решению линейной задачи о дополнительности [9]. Он не допускает проникание тел, но отличается высокой вычислительной сложностью для невыпуклых объектов. Импульсные методы [10, 11] предполагают мгновенные контакты между объектами, поэтому они не могут быть применены для моделирования контакта между деформируемыми объектами. В [12, 13] описана система для обработки взаимодействия деформируемых объектов, образованных жесткими каркасами, на которые прикреплен деформируемый слой. Недостатком метода является то, что модели объектов, созданные таким образом, склонны к бесформенности.

В последние годы широкое распространение получили модели объектов на основе точечной дискретизации [14-17]. Для таких моделей задача определения локальной деформации объектов и определения СКВ была решена сравнительно недавно. Впервые решение рассматриваемой задачи в такой постановке приведено в [18]. Этот метод основан на решении линейной задачи о дополнительности [9] с использованием алгоритма Лемке [19]. Взаимодействующие объекты представляются квазижесткими моделями [20]. В таких моделях объекты рассматриваются как твердые тела с упругими поверхностями. В [21, 22] описаны методы, основанные на механике сплошных сред, где объем и поверхность объекта рассматриваются как облака точек. Недостатком перечисленных методов, рассматривающих модели объектов на основе точечной дискретизации, помимо высокой вычислительной сложности, является серьезное несоответствие направлений и значений рассчитанных СКВ реальным силам, возникающим в процессе взаимодействия объектов.

Далее будет рассмотрен алгоритм определения СКВ между объектами, математические модели которых основаны на точечной дискретизации, лишенный

перечисленных недостатков. Правильность моделирования при использовании предлагаемого метода легко доказуема, потому что решение задачи Синьорини основано на законах теории линейной упругости и законе трения Амонтона — Кулона.

Определение контактной поверхности. Моделирование захвата осуществляется путем пошагового изменения положения элементов ЗУМ для перевода его в состояние «захватное устройство закрыто». На некотором шаге поверхности ОМ и звена ЗУМ начинают пересекаться.

Поверхности ОМ и звена ЗУМ представлены в виде матриц Р' =

= [р[, ..., р'ы ] т и $ = [q[,..., ^м ] т , строки которых содержат координаты вершин полигональных моделей ОМ и звена ЗУМ.

В [23] описан алгоритм определения областей пересечения поверхностей ЗУМ и деформируемого объекта при моделировании захвата. Если пересечение обнаружено, выполняется расчет его параметров.

Первым параметром является область пересечения, которая представляет собой фигуру, образованную в результате конъюнкции фигур ЗУМ и ОМ. Она

задается двумя матрицами Р = [р1,..., рп ] и Q = [q1,..., qm ] , строки которых являются координатами вершин полигональных моделей объекта и звена, потенциально испытывающих смещение вследствие деформации. Вторым параметром является глубина проникания ЗУМ в ОМ при захвате, т. е. минимальное расстояние, на которое нужно развести эти объекты, чтобы их поверхности перестали пересекаться. Третьим параметром — вектор, вдоль которого отсчиты-вается глубина проникания. Последние два параметра задаются двумя матрицами глубин прониканий 8Р =[5 р1,..., 5 рп ]т и 5Q =[5q1,..., 8qm ]т, составленных из векторов, нормы которых равны глубинам проникания для вершин из матриц Р и Q. Векторы 5Р1 (г = 1,2,..., п) сонаправлены, а векторы () = 1,2,..., т) противоположно направлены с вектором движения звена ЗУМ относительно объекта V на текущем шаге моделирования (рис. 1).

Полагаем, что строки матриц вершин пятна контакта ОМ Яр = [ Тр1,..., Трп ] и

пятна контакта звена ЗУМ ЯQ =[тЧ1,..., тЧт ]т формируются из координат точек, полученных путем смещения вершин рг (г = 1, 2,..., п) и qj () = 1, 2,..., п) вдоль соответствующих векторов проникания 5рг (г = 1,2,...,п) и (j = 1,2,..., т) (см. рис. 1).

Принимаем такие смещения обратно пропорциональными модулям упругости -Езум и ЕОМ материалов, из которых изготовлены звено ЗУМ и ОМ. Тогда можно записать:

Яр = р + 5р 1 ЕоМ-« Яр = Р + 5р- ЕзУМ -

1/ еом +1/ -езум еом + е

ЗУМ

V n^R V-ЗУМ ^ я ЕОМ Rq = Q + ÖQ ——--- Rq = Q + ÖQ -

1 еом +1 езум еом + е

ЗУМ

В процессе захвата звено ЗУМ вступает в контакт с ОМ, в результате чего формируется пара пятен контакта, принадлежащих поверхностям ОМ и ЗУМ. Поскольку эти пятна имеют одинаковую форму, для каждой вершины из Яр и ЯQ существуют точки на поверхностях звена и объекта, с которыми они находятся в контакте. Поэтому далее рассматриваем пару пятен контакта как единую контактную поверхность, заданную матрицей вершин Я = [Яр ]т [ЯQ ]т

= [ Т\ , ..., Гп, Гп+1,..., Тп+т ]т (см. рис. 1).

Найдем функцию, описывающую контактную поверхность. Для вершин, координаты которых содержатся в строках матрицы Я, решаем задачу интерполирования сплайн-поверхностью [24], т. е. восстанавливаем функцию ф(тх, Ту)« т% , основанную на данных интерполяции тх , Ту, т^ (г = 1,2,..., п + т). Для этого необходимо решить систему линейных алгебраических уравнений:

п + т

фТ, Ту) = x Сг[(тх - Тх )2 + (Ту - Ту )2]1п[(тх - т1х )2 + (Ту - Ту )2] + Атх + ВТу + В,

г=1

п + т п + т п + т

X С = 0, X С х> = 0, X С уг = 0, ф Тг, Туг) = тгг (г = 1,2,..., п + т).

г = 1 г = 1 г = 1

Найдем нормали контактной поверхности в точках, координаты которых содержатся в строках матрицы Я. Направление нормалей выбирается таким образом, чтобы они были направлены внутрь ОМ. Векторы нормалей пг рассчитываются из соотношения

к - 1

(Тк - Тг )х(т1 - Тг)+ £ [(Т. - Т) х (т. + 1 - Т )]

) = 1

n,i =

k -1

(rk - r,i )x(ri - Tj)+ £ [(rj - r ) X (rj + 1 - ri )]

j=1

, j = 1, ..., n + m,

где Г — радиус-векторы вершин, образующих треугольники с вершиной г после формирования триангуляции Делоне [25] для множества вершин, содержащихся в строках матрицы Я.

Определение смещений вершин ОМ и звена ЗУМ. Введем в рассмотрение матрицы смещений вершин ОМ иОМ и звена ЗУМ иЗУМ (см. рис. 1):

иом -

изум -

Т т т ____|Т

[rp -p]х [rq -q- Oq j I -I иом1, •••> uomn, иоми+1,-", uoMn+m I ;

_ т т

[Rp - p-5р ] [rq -q ] = [изум1> •••, ЩуМп, изумп+1 , •••> иЗУМп+т ] •

Матрице вершин Я соответствуют матрицы нормальных иОМ^ и касательных иОМт смещений вершин ОМ, а также нормальных иЗуМм и касательных иЗумт смещений вершин звена ЗУМ (рис. 2).

"зум;-

"зум> ■ изуш' йзуш

"зумг'

_"омг_"омг ■ "ом; • иомг

Рис. 2. Определение смещений вершин ОМ и звена ЗУМ

Поскольку при захвате поверхности ОМ и звена ЗУМ деформируются, изменяются и направления нормалей этих поверхностей. Поэтому строки матриц смещений имеют вид:

иОМ№ = иОМгпОМгпп ; иОМтг = ^ОМг (иОМг " иОМгпОМгпОМг )^ОМг_1; иЗУМ№ = иЗУМгпЗУМгптг ; иЗУМхг = ^ЗУМг (иЗУМг " иЗУМгпЗУМгпЗУМг )^ЗУМг_1,

где nOMi, n3yMi, nri — единичные векторы нормалей поверхностей объекта, звена и контактной поверхности в соответствующих точках; qOMi и q3yMi — кватернионы такие, что

( ( noMi«ri Л ( «OMi«r

qOMi =) cos I arccos-I, nOMi x nri cos I arccos-

n3yMinri I ( n3YMinr

q3yMi =<j cos I arccos---I, n3yMi x nri cos I arccos--—

Определение сил контактного взаимодействия. Представим распределенную СКВ, с которой звено ЗУМ действует на ОМ, в виде матрицы, строки которой являются векторами сосредоточенных сил FOM =[ /ОМ1, ..., /омп+ш ]т, приложенными к вершинам, содержащимся в матрице R . Справедливо следующее равенство:

FOM = FOMN + FOMt >

где FomN =[ /oMN1, ..., /oMN(n+m) ] и Fomт =[ /Омт1, ..., /оМф+m) ] — матрицы, строки которых есть векторы нормальных и тангенциальных сил, с которыми звено ЗУМ действует на ОМ.

Аналогично можно представить распределенную СКВ, с которой ОМ действует на звено ЗУМ:

F3yM = F3yMN + F3yM т >

где F3yMN =[ /3yMN 1, ..., /3yMN (n+m) ] и F3yM т=[ /3УМ т1, ..., /3УМ ф+m) ] .

Для нахождения матриц сил FOMN, FOMt, F3yMN и F3yMt необходимо решить задачу теории упругости, которая заключается в определении сил по известным перемещениям точек тела, т. е. нужно найти отношение между матрицами смещений UoMN , «ОМт , «3yMN , «3УМт и сил FomN , FoMx , Fwmn , F3yMт.

Поскольку рассматриваются малые деформации, физическая модель может быть основана на теории линейной упругости. В качестве метода описания механики контакта было выбрано приближение Буссинеска [26], в котором поверхность вокруг точек контакта представляется как упругое полупространство [2].

Поскольку предполагается линейная упругость материала, векторы нормального uNj и касательного uZj смещений для точки rj, вызванные множествами векторов сосредоточенных нормальных FN =[/N1, ..., /Nm ]т и касательных FT =[/т1, ..., /Tm ]т сил, могут быть найдены как суперпозиции векторов смещений:

uNj = ^ i fa М

2nG k = 1, k ^j lk ESj

Uy = hl £ h., Ъ

2пС к = 1, к #) 1к СБ]

где V — коэффициент Пуассона; Е и С — модули Юнга и сдвига; 1к — расстояние между вершинами т и Гк, к которым приложены нормальная к и тангенциальная /тк точечные силы; Sj — площадь поверхности, на которую действуют нормальная /щ и тангенциальная точечные силы, приложенные к вершине т^. Площадь определяется из равенства

1 т -1

Sj = - £ ||(т-т1 )*(*+1 -т1 )||,

4 I = 2

где т (I = 1, 2, ..., т) — последовательность радиус-векторов вершин, образующих треугольники с вершиной Tj после формирования триангуляции Делоне [25] для множества вершин, содержащихся в строках матрицы Я, обеспечивающая обход вершины т против хода часовой стрелки, что формирует алгоритм Джарвиса [27].

После обобщения для всех точек контактной поверхности, связь между Ромм , -Омт, Рзумм , Рзумт и «омы , «омт, «зуми , «зумт может быть выражена в матричной форме:

«ОМЫ = ^ом -омм ; (1)

иЗУМЫ = WЗУМРЗУМЫ ; (2)

иОМт = ЖоМ-ОМт ; (3)

иЗУМт= ^ЗУМ -ЗУМт , (4)

где и ^ЗУМ — передаточные матрицы ОМ и звена ЗУМ размера

[п + тхп + т], элементы которых вычисляются по формулам:

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

_ 1 1 -Уом

^ОМи -- ; WoМгj

EoMSi 2%GomIj

1 1 -Узум ^ЗУМгг -—-Г"; ^зуму =

ЕЗУМ^' 2%G3yMlj

где ЕОМ, Езум — модули Юнга объекта и звена ЗУМ; vOM и v3yM — коэффициенты Пуассона ОМ и ЗУМ; GOM и G3yM — модули сдвига объекта и звена ЗУМ; Si — площадь поверхности, на которую действуют точечные силы, приложенные к вершине ri; lj — расстояние между вершинами ri и Гу. Расстояние l j определяется из соотношения

m - 1 ._

lj = £ VXA2 + Уд2 + [ф(rix + (к + 1)хд,riy + (к +1)уд)-ф(rix + Хдк,riy + yAк)]2;

к = 1

Хд =-; уд = -

m m

где ф — восстановленная функция контактной поверхности; т — количество шагов расчета; Хд и уд — значение шага по координатам х и y. Вычитая (2) из (1) и (4) из (3), получаем

иоми - изуми = ^омРомы ~ МзумРзумм ; (5)

иОмт _ иЗУМт = ^ом рОМт _ ^ЗУМ РЗУМт . (6)

Ввиду того, что эпюры сил, действующих на Ом и ЗУм, зеркально симметричны относительно поверхности пятна контакта, справедливы равенства

ромм = _Рзумм = РИ ; рОмт = _Рзумт = Рт.

Значит, (5) и (6) можно записать в виде

иОмИ - иЗУмИ = (^ом + ^зум )РИ ; (7)

иОмт _ иЗУмт = (Жэм + ^зум Ж • (8) Из соотношений (7) и (8) следует справедливость равенств

= (Жж + ^зум )т (иоми - изуми);

Рт = (Жж + ^ЗУм )т (иОмт _ иЗУмт ).

Тогда выражения для матриц нормальных Роми , РЗуми и тангенциальных Ромт, Рзумт сил примут вид:

Роми = (Жж + ^зум )т (иоми - изуми); Рзуми = _(Жэм + ^зум )т (иоми - изуми); Ромт = (Жж + ^ЗУм )т (иОмт _ иЗУмт ); рЗУмт = _(Жэм + ^ЗУм )т (иОмт _ иЗУмт ). Примем, что между телами существует сухое трение, согласно закону трения Амонтона — Кулона в его простейшем виде [28]: максимальная сила трения покоя /тртах равна силе трения скольжения /ск, которая, в свою очередь, равна нормальной силе /и , умноженной на постоянный коэффициент трения ц,:

/тртах _ /ск ~ Ц/И •

Введем в рассмотрение матрицы Ромтр =[/омтр1, •••, /омтр(«+т) и

РЗумтр =[/Зумтр1, •••, /ЗУмтр(н+т) ]т , их строки являются векторами сил трения, приложенными к вершинам, которые содержатся в матрице Я, со стороны Ом и ЗУм^

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

В этом случае справедливы равенства:

—ОМтр = рОМт ; рЗУМтр = РЗУМт •

Если рассматривается контакт без адгезии и прилипания, то на краю области схватывания касательное напряжение стремится к бесконечности, в то время как нормальное напряжение стремится к нулю. Это означает, что в большинстве случаев условие схватывания вблизи края области контакта не выполняется. В этой области будет иметь место проскальзывание [2]. Таким образом, контактная поверхность разделяется на две области — схватывания и проскальзывания.

В этом случае матрицы трения РОМтр, РЗУМтр и нормальных сил Рзумм , РЗУМт будут формироваться по следующему правилу:

Наконец, матрицы сил контактного взаимодействия РОМ и РЗуМ с учетом наличия между ОМ и звеном ЗУМ сухого трения можно записать как

Экспериментальная часть. Приведенные алгоритмы расчета контактных поверхностей и СКВ реализованы на функционально-моделирующем стенде (Дмитровский филиал МГТУ им. Н.Э. Баумана).

Аппаратная часть стенда состоит из захватных устройств Schunk WSG50, оснащенных датчиками силы (ДС) и датчиками положения (ДП) звеньев. Программная часть реализована с использованием операционной системы ROS. Она включает в себя драйверы ЗУМ Schunk WSG50, ДС и ДП звеньев ЗУМ, системы расчета пересечений поверхностей моделей ОМ и звеньев ЗУМ, контактных поверхностей, глубин проникновения, СКВ между объектом и звеньями, а также систему визуализации, отображающую положение ЗУМ относительно ОМ и положение его звеньев.

В качестве ОМ был выбран резиновый мяч с известными модулями Юнга и сдвига и коэффициентом Пуассона. Способы определения упругих свойств объекта, а также коэффициента трения между звеньями ЗУМ и ОМ приведены в [29]. На кончики звеньев ЗУМ наклеены мягкие накладки в форме дисков с известными упругими характеристиками.

На рис. 3 показан способ захвата ОМ захватным устройством Schunk

/зУМтг ^ Ц/зУМАТг ^ /эУМтрг - /зУМтг > /зУМтг > Н/ЗУМNi ^ /эУМТРг = О, /ЗУММ = О,

^ i = 1,2,..., n + m.

^ом - ^омn + ромтр;

-ЗУМ = РЗУМN + -ЗУМтр .

WSG50.

Рис. 3. Способ захвата ОМ

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

Рис. 4. Работа системы визуализации и системы определения контактной поверхности

На рис. 5 стрелками показаны нормальные и тангенциальные составляющие СКВ (а, б), силы трения (в) и СКВ (г), соответствующие вершинам контактной поверхности.

На рис. 6 приведены графики зависимостей показаний ДП и ДС звена ЗУМ от времени.

Значение силы -ДС зафиксированного ДС звена ЗУМ равно 16,7 Н. В соответствии с алгоритмом расчета, модуль сосредоточенной СКВ составил 17,2 Н. Это значение получено суммированием норм строк матрицы РЗУМ. Точка при-

ложения сосредоточенной СКВ /с рассчитывается как положение центра масс, где в качестве масс элементов принимаются модули сил СКВ:

X Ц/зУМгЦТг

Гс =■

/ ЗУМг

Рис. 5. Расчет сил контактного взаимодействия

А/, Н-м Разность между расчетным и зафик-

сированным значениями объясняется тем, что ДС фиксирует нормальную компоненту силы, приложенной к центру дисков /0 на кончиках звеньев ЗУм до контакта с Ом. Координаты /0 известны из конструктивных характеристик звена. Фактически ДС представляет собой датчик, измеряющий момент Для получения значения силы зафиксированное значение момента делят на плечо Ц/оЦ- Точка приложения рассчитанной равнодействующей СКВ гс отличается от центра дисков Рис. 6. Графики зависимостей пока- на кончиках звеньев ЗУм, а ее направле-заний ДП (1) и ДС (2) звена ЗУм ние не совпадает с нормалью Пзум дисков от времени до контакта с ОМ.

момент Мдс, который возникает от зафиксированной ДС силы, вокруг оси ДС составляет 1,04 Н-м. Он рассчитывается по формуле МдС = РдС || /01|.

момент МЗум, который возникает от компоненты рассчитанной СКВ вдоль пЗум, вокруг оси ДС составляет 1,13 Н-м. Он определяется как МЗум = = рзумпзум 111с _ 1спЗУмпЗУм || •

Таким образом, разность между рассчитанной СКВ и зафиксированной силой составила 8,7 %.

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

Достоинствами предложенного метода является небольшая вычислительная сложность по сравнению с ранее разработанными алгоритмами [18, 21, 22] и простота реализации. Кроме того, рассчитанные с помощью рассмотренного способа направления и значения СКВ соответствуют реальным силам, возникающим в процессе взаимодействия объектов.

Алгоритм расчета контактных поверхностей и СКВ реализован на функционально-моделирующем стенде в Дмитровском филиале МГТУ им. Н.Э. Баумана [29]. Правильность предложенного метода доказана на основе экспериментальных исследований, в ходе которых установлено, что рассчитанное значение отличается от реального менее чем на 9 %.

Результаты работы алгоритма расчета контактных поверхностей и СКВ могут быть использованы для оценки качества захвата и формирования сигналов управления звеньями ЗУМ в случае, если захватное устройство не оснащено тактильными датчиками, или когда захват ОМ осуществляется областями звеньев, не оснащенных очувствлением.

ЛИТЕРАТУРА

1. Лесков А.Г., Илларионов В.В., Калеватых И.А. и др. Аппаратно-программный комплекс для решения задач автоматического захвата объекта манипуляторами // Инженерный журнал: наука и инновации. 2015. № 1. DOI: 10.18698/2308-6033-2015-1-1361

URL: http://engjournal.ru/ catalog/prubor/robot/1361 .html

2. Попов В.Л. Механика контактного взаимодействия и физика трения. М.: Физматлит, 2013. 352 с.

3. Kikuchi N., Oden J.T. Contact problems in elasticity: a study of variational inequalities and finite element methods. Society for Industrial and Applied Mathematics, 1988. 485 p.

4. Teschner M., Kimmerle S, Zachmann G, Heidelberger B., et al. Collision detection for deformable objects // Proc. Eurographics. 2004. Р. 119-135.

5. Terzopoulos D., Platt J.C., Barr A.H. Elastically deformable models // Proc. 14th Special Interest Group on Graphics and Interactive Techniques. 1987. Vol. 21. No. 4. Р. 205-214.

DOI: 10.1145/37402.37427

6. Moore M., Wilhelms J. Collision detection and response for computer animation // Proc. 15th Special Interest Group on Graphics and Interactive Techniques. 1988. Vol. 22. No. 4. P. 289-298. DOI: 10.1145/378456.378528

7. Platt J.C., Barr A.H. Constraint methods for flexible models // Proc. 15th Special Interest Group on Graphics and Interactive Techniques. 1988. Vol. 22. No. 4. Р. 279-288.

DOI: 10.1145/378456.378524

8. BaraffD., Witkin A. Dynamic simulation of non-penetrating flexible bodies // Proc. 19th Special Interest Group on Graphics and Interactive Techniques. 1992. Vol. 26. No. 2. Р. 303-308.

DOI: 10.1145/142920.134084

9. Alefeld G., Wang Z., Shen Z. Solutions of linear complementarity problems for H-matrices // Reliable Computing. 2004. Vol. 10. No. 6. Р. 423-435. DOI: 10.1023/B:REOM.0000047093.79994.8f

10. Hahn J.K. Realistic animation of rigid bodies // Proc. 15th Special Interest Group on Graphics and Interactive Techniques. 1988. Vol. 22. No. 4. Р. 299-308.

11. Mirtich B., Canny J. Impulse-based simulation of rigid bodies // Proc. 1995 symposium on Interactive 3D graphics. 1995. Р. 181-190. DOI: 10.1145/378456.378530

12. Gascuel M.-P. An implicit formulation for precise contact modeling between flexible solids // Proc. 20th Special Interest Group on Graphics and Interactive Techniques. 1993. Р. 313-320. DOI: 10.1145/166117.166157

13. Desbrun M., Gascuel M.-P. Animating soft substances with implicit surfaces // Proc. 22nd Special Interest Group on Graphics and Interactive Techniques. 1995. Р. 287-290.

DOI: 10.1145/218380.218456

14. Pfister H., Zwicker M., Baar J., Gross M. Surfels: surface elements as rendering primitives // Proc. 27th Special Interest Group on Graphics and Interactive Techniques. 2000. Р. 335-342. DOI: 10.1145/344779.344936

15. Zwicker M., Pauly M., Knoll O., Gross M. Pointshop 3d: An interactive system for point-based surface editing // Proc. 29th Special Interest Group on Graphics and Interactive Techniques. 2002. Р. 322-329. DOI: 10.1145/566570.566584

16. Perspective accurate splatting / M. Zwicker, J. Rasanen, M. Botsch, C. Dachsbacher, M. Pauly // Proc. Graphics Interface. 2004. Р. 247-254. URL: https://dl.acm.org/citation.cfm?id=100608

17. Guennebaud G., Barthe L., Paulin M. Deferred splatting // Proc. Eurographics. 2004. Vol. 23. No. 3. Р. 653-660.

18. Pauly M., Keiser R., Kobbelt L.P., Gross M. Shape modeling with point-sampled geometry // Proc. 30th Special Interest Group on Graphics and Interactive Techniques. 2003. Vol. 23. No. 3. Р. 641-650. DOI: 10.1145/882262.882319

19. More J.J. Classes of functions and feasibility conditions in nonlinear complementarity problems // Math. Programming. 1974. Vol. 6. No. 1. Р. 327-338. DOI: 10.1007/BF01580248

20. Pauly M., Pai D.K., Guibas L.J. Quasi-rigid objects in contact // Proc. 31st Special Interest Group on Graphics and Interactive Techniques. 2004. Р. 109-119. DOI: 10.1145/1028523.1028539

21. Muller M., Keiser R., Nealen A., Pauly M., et al. Point based animation of elastic, plastic and melting objects // Proc. Eurographics symposium on Computer animation. 2004. Р. 141-151. DOI: 10.1145/1028523.1028542

22. Contact handling for deformable point-based objects / R. Keiser, M. Müller, B. Heidelberger, M. Teschner, M. Gross // Proc. Vision, Modeling, and Visualization. 2004. Р. 665-674.

23. Лесков А.Г., Феоктистова Е.В. Алгоритм определения пересечения произвольных полигональных моделей для нахождения коллектора контакта, нормалей и глубины проникновения при планировании и моделировании захвата деформируемого объекта // Сборник докладов VIII Всероссийской конференции молодых ученых и специалистов «Будущее машиностроения России». М.: Изд-во МГТУ им. Н.Э. Баумана, 2015. С. 988-992.

24. Ашкеназы В.О. Сплайн-поверхности. Основы теории и вычислительные алгоритмы. Тверь: Тверской гос. ун-т, 2003. 82 с.

25. Скворцов А.В. Триангуляция Делоне и ее применение. Томск: Изд-во Томского ун-та, 2002. 128 с.

26. Леденев В.В., Однолько В.Г., Нгуен З.Х. Теоретические основы механики деформирования и разрушения. Тамбов: Изд-во ТГТУ, 2013. 312 с.

27. Васильков Д.М. Геометрическое моделирование и компьютерная графика: вычислительные и алгоритмические основы. Минск: Изд-во БГУ, 2011. 203 с.

28. Алексеев А.Е. Нелинейные законы сухого трения в контактных задачах линейной теории упругости // Прикладная механика и техническая физика. 2002. Т. 43. № 4. С. 161-169.

29. Лесков А.Г., Селиверстова Е.В., Бажинова К.В. Определение в автоматическом режиме упругих свойств объекта манипулирования и коэффициента трения между объектом и звеньями захватного устройства // Сборник докладов IX Всероссийской конференции молодых ученых и специалистов «Будущее машиностроения России». М.: Изд-во МГТУ им. Н.Э. Баумана, 2016. С. 665-667.

Лесков Алексей Григорьевич — д-р техн. наук, профессор, директор Дмитровского филиала МГТУ им. Н.Э. Баумана (Российская Федерация, 141801, Московская обл., Дмитровский р-н, пос. Орево).

Селиверстова Елена Владимировна — инженер Дмитровского филиала МГТУ им. Н.Э. Баумана (Российская Федерация, 141801, Московская обл., Дмитровский р-н, пос. Орево), аспирантка кафедры «Робототехнические системы и мехатроника» МГТУ им. Н.Э. Баумана (Российская Федерация, 105005, Москва, 2-я Бауманская ул., д. 5, стр. 1).

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

Лесков А.Г., Селиверстова Е.В. Расчет сил контактного взаимодействия между деформируемым объектом и звеньями захватного устройства манипулятора // Вестник МГТУ им. Н.Э. Баумана. Сер. Машиностроение. 2018. № 3. С. 58-74. Б01: 10.18698/0236-3941-2018-3-58-74

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

COMPUTING CONTACT FORCES BETWEEN A DEFORMABLE OBJECT AND GRIPPER LINKS OF A MANIPULATOR

A.G. Leskov1 [email protected]

E.V. Seliverstova1' 2 [email protected]

1 Dmitrov Branch, Bauman Moscow State Technical University, Orevo, Dmitrosvkiy District, Moscow Region, Russian Federation

2 Bauman Moscow State Technical University, Moscow, Russian Federation

Abstract Keywords

We analysed the methods of computing contact forces Grasp, deformable object, simulation, between gripper links of a manipulator and a deformable automatic object grasping, contact object of manipulation. This problem is important for forces, grasp planning, Schunk WSG50 grasp simulation and planning. We present an original method for determining contact forces between objects, whose surfaces are modelled using point-based discretisation. We provide a solution to the Signorini problem based on the laws of linear elasticity theory and the

simulation and planning. We present an original method for determining contact forces between objects, whose surfaces are modelled using point-based discretisation. We provide a solution to the Signorini problem based on the laws of linear elasticity theory and the Amonton — Coulomb model of friction. To compute the intersections of the object and gripper surfaces, we used an algorithm described in our previous works that takes into account the direction of the gripper link motion relative to the object. Advantages of the method proposed are low computational complexity and ease of implementation. We developed computer software

and present experimental results that prove the efficiency of Received 21.10.2017 the algorithm © BMSTU, 2018

REFERENCES

[1] Leskov A.G., Illarionov V.V., Kalevatykh I.A., et al. Hardware-software complex for solving the task of automatic capture of the object with manipulators. Inzhenernyy zhurnal: nauka i innovatsii [Engineering Journal: Science and Innovation], 2015, no. 1 (in Russ.).

DOI: 10.18698/2308-6033-2015-1-1361

Available at: http://engjournal.ru/catalog/prubor/robot/1361.html

[2] Popov V.L. Mekhanika kontaktnogo vzaimodeystviya i fizika treniya [Mechanics of contact interaction and physics of friction]. Moscow, Fizmatlit Publ., 2013. 352 p.

[3] Kikuchi N., Oden J.T. Contact problems in elasticity: a study of variational inequalities and finite element methods. Society for Industrial and Applied Mathematics, 1988. 485 p.

[4] Teschner M., Kimmerle S., Zachmann G., Heidelberger B., et al. Collision detection for deformable objects. Proc. Eurographics, 2004, pp. 119-135.

[5] Terzopoulos D., Platt J.C., Barr A.H. Elastically deformable models. Proc. 14th Special Interest Group on Graphics and Interactive Techniques, 1987, vol. 21, no. 4, pp. 205-214.

DOI: 10.1145/37402.37427

[6] Moore M., Wilhelms J. Collision detection and response for computer animation. Proc. 15th Special Interest Group on Graphics and Interactive Techniques, 1988, vol. 22, no. 4, pp. 289-298. DOI: 10.1145/378456.378528

[7] Platt J.C., Barr A.H. Constraint methods for flexible models. Proc. 15th Special Interest Group on Graphics and Interactive Techniques, 1988, vol. 22, no. 4, pp. 279-288. DOI: 10.1145/378456.378524

[8] Baraff D., Witkin A. Dynamic simulation of non-penetrating flexible bodies. Proc. 19th Special Interest Group on Graphics and Interactive Techniques, 1992, vol. 26, no. 2, pp. 303-308.

DOI: 10.1145/142920.134084

[9] Alefeld G., Wang Z., Shen Z. Solutions of linear complementarity problems for H-matrices. Reliable Computing, 2004, vol. 10, no. 6, pp. 423-435. DOI: 10.1023/B:REOM.0000047093.79994.8f

[10] Hahn J.K. Realistic animation of rigid bodies. Proc. 15th Special Interest Group on Graphics and Interactive Techniques, 1988, vol. 22, no. 4, pp. 299-308.

[11] Mirtich B., Canny J. Impulse-based simulation of rigid bodies. Proc. 1995 symposium on Interactive 3D graphics, 1995, pp. 181-190. DOI: 10.1145/378456.378530

[12] Gascuel M.-P. An implicit formulation for precise contact modeling between flexible solids. Proc. 20th Special Interest Group on Graphics and Interactive Techniques, 1993, pp. 313-320.

DOI: 10.1145/166117.166157

[13] Desbrun M., Gascuel M.-P. Animating soft substances with implicit surfaces. Proc. 22nd Special Interest Group on Graphics and Interactive Techniques, 1995, pp. 287-290.

DOI: 10.1145/218380.218456

[14] Pfister H., Zwicker M., Baar J., Gross M. Surfels: surface elements as rendering primitives. Proc. 27th Special Interest Group on Graphics and Interactive Techniques, 2000, pp. 335-342.

DOI: 10.1145/344779.344936

[15] Zwicker M., Pauly M., Knoll O., Gross M. Pointshop 3d: An interactive system for point-based surface editing. Proc. 29th Special Interest Group on Graphics and Interactive Techniques, 2002, pp. 322-329. DOI: 10.1145/566570.566584

[16] Zwicker M., Rasanen J., Botsch M., Dachsbacher C., Pauly M. Perspective accurate splatting. Proc. Graphics Inter/ace, 2004, pp. 247-254. Available at: https://dl.acm.org/citation.cfm?id=100608

[17] Guennebaud G., Barthe L., Paulin M. Deferred splatting. Proc. Eurographics, 2004, vol. 23, no. 3, pp. 653-660.

[18] Pauly M., Keiser R., Kobbelt L.P., Gross M. Shape modeling with point-sampled geometry. Proc. 30th Special Interest Group on Graphics and Interactive Techniques, 2003, vol. 23, no. 3, pp. 641-650. DOI: 10.1145/882262.882319

[19] More J.J. Classes of functions and feasibility conditions in nonlinear complementarity problems. Math. Programming, 1974, vol. 6, no. 1, pp. 327-338. DOI: 10.1007/BF01580248

[20] Pauly M., Pai D.K., Guibas L.J. Quasi-rigid objects in contact. Proc. 31st Special Interest Group on Graphics and Interactive Techniques, 2004, pp. 109-119. DOI: 10.1145/1028523.1028539

[21] Muller M., Keiser R., Nealen A., Pauly M., Gross M., Alexa M. Point based animation of elastic, plastic and melting objects. Proc. Eurographics symposium on Computer animation, 2004, pp. 141-151. DOI: 10.1145/1028523.1028542

[22] Keiser R., Müller M., Heidelberger B., Teschner M., Gross M. Contact handling for deformable point-based objects. Proc. Vision, Modeling, and Visualization, 2004, pp. 665-674.

[23] Leskov A.G., Feoktistova E.V. [Algorithm for determining the intersection of arbitrary polygonal models for finding the contact collector, normals and depth of penetration during planning and modeling the grasp of a deformable object]. Sb. dokl. VIII Vserossiyskoy kon/. molodykh uchenykh i spetsialistov «Budushchee mashinostroeniya Rossii» [Proc. VIII Russ. Conf. of Young Scientists and Specialists "The Future of Mechanical Engineering in Russia"]. Moscow, Bauman MSTU Publ., 2015. Pр. 988-992.

[24] Ashkenazy V.O. Splayn-poverkhnosti. Osnovy teorii i vychislitel'nye algoritmy [Pline surfaces. Fundamentals of the theory and computational algorithms]. Tver', TSU Publ., 2003. 82 p.

[25] Skvortsov A.V. Triangulyatsiya Delone i ee primenenie [Delaunay triangulation and its Application]. Tomsk, TSU Publ., 2002. 128 p.

[26] Ledenev V.V., Odnol'ko V.G., Nguen Z.Kh. Teoreticheskie osnovy mekhaniki deformirova-niya i razrusheniya [Theoretical foundations of deformation and fracture mechanics]. Tambov, TSTU Publ., 2013. 312 p.

[27] Vasil'kov D.M. Geometricheskoe modelirovanie i komp'yuternaya grafika: vychislitel'nye i algoritmicheskie osnovy [Geometric modeling and computer graphics: computational and algorithmic fundamentals]. Minsk, BSU Publ., 2011. 203 p.

[28] Alekseev A.E. Nonlinear deformation and stability of noncircular cylindrical shells under internal pressure and axial compression. Journal o/ Applied Mechanics and Technical Physics, 2002, vol. 43, no. 4, pp. 617-621. DOI: 10.1023/A:1016066001346

[29] Leskov A.G., Seliverstova E.V., Bazhinova K.V. [Determination of elastic properties of manipulated object and the coefficient of friction between object and links of gripper device in automatic mode]. Sb. Dokl. IX Vserossiyskoy konf. molodykh uchenykh i spetsialistov «Budushchee mashinostroeniya Rossii» [Proc. IX Russ. Conf. of Young Scientists and Specialists "The Future of Mechanical Engineering in Russia"]. Moscow, Bauman MSTU Publ., 2016. Pp. 665-667.

Leskov A.G. — Dr. Sc. (Eng.), Professor, Director of the Dmitrov Branch, Bauman Moscow State Technical University (Orevo, Dmitrosvkiy District, Moscow Region, 141801 Russian Federation).

Seliverstova E.V. — Engineer, Dmitrov Branch, Bauman Moscow State Technical University (Orevo, Dmitrosvkiy Region, Moscow Region, 141801 Russian Federation); post-graduate student, Department of Robotics and Mechatronics, Bauman Moscow State Technical University (2-ya Baumanskaya ul. 5, str. 1, Moscow, 105005 Russian Federation).

Please cite this article in English as:

Leskov A.G., Seliverstova E.V. Computing Contact Forces Between a Deformable Object and Gripper Links of a Manipulator. Vestn. Mosk. Gos. Tekh. Univ. im. N.E. Baumana, Mashinostr. [Herald of the Bauman Moscow State Tech. Univ., Mech. Eng.], 2018, no. 3, pp. 58-74 (in Russ.). DOI: 10.18698/0236-3941-2018-3-58-74

В Издательстве МГТУ им. Н.Э. Баумана вышла

в свет монография авторов В.М. Кашина, В.Д. Свечарника, В.Л. Солунина, А.Б. Шаповалова

«Исследование процессов в приводе наведения установки в упрежденную точку на траектории»

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

По вопросам приобретения обращайтесь:

105005, Москва, 2-я Бауманская ул., д. 5, стр. 1 +7 (499) 263-60-45 [email protected] www.baumanpress.ru

ЦЕНТРАЛЬНЫЙ ш^ш паупю-исследовательский ™ itltCTtimAD ТОМАТИКИ

шиишг ;t гидравлики

ИССЛЕДОВАНИЕ ПРОЦЕССОВ В ПРИВОДЕ НАВЕДЕНИЯ УСТАНОВКИ В УПРЕЖДЕННУЮ ТОЧКУ НА ТРАЕКТОРИИ

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