Научная статья на тему 'МЕТОДЫ УПРАВЛЕНИЯ МАНИПУЛЯТОРАМИ НА БАЗЕ ТРИПОДА ПРИ ВЫПОЛНЕНИИ ТЕХНОЛОГИЧЕСКИХ ОПЕРАЦИЙ'

МЕТОДЫ УПРАВЛЕНИЯ МАНИПУЛЯТОРАМИ НА БАЗЕ ТРИПОДА ПРИ ВЫПОЛНЕНИИ ТЕХНОЛОГИЧЕСКИХ ОПЕРАЦИЙ Текст научной статьи по специальности «Механика и машиностроение»

CC BY
246
44
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
МАНИПУЛЯТОРЫ НА БАЗЕ ТРИПОДА / ПАРАЛЛЕЛЬНО-ПОСЛЕДОВАТЕЛЬНАЯ СТРУКТУРА / УПРАВЛЯЕМОЕ ЗАХВАТНОЕ УСТРОЙСТВО / МЕТОДЫ УПРАВЛЕНИЯ

Аннотация научной статьи по механике и машиностроению, автор научной работы — Воробьева Н.С.

Манипуляторы параллельно-последовательной (гибридной) структуры нашли широкое применение в различных отраслях экономики, что позволяет учесть недостатки и совместить преимущества манипуляционных систем параллельной и последовательной структур. Исследования технологических процессов показали, что их можно выполнять с помощью манипуляторов параллельно-последовательной структуры на основе трипода, особенности которых до конца не изучены. При этом важное значение имеет выбор системы и алгоритмов управления, зависящих от особенностей технологических операций. Управление манипулятором является комплексной задачей, включающей в себя позиционирование рабочего органа, планирование и синтез траекторий, перемещение рабочего органа по заданной траектории. Каждый технологический процесс можно описать набором специальных траекторий, которые можно заранее внести в базу моделей управления. На примере конкретных технологических операций формализованы траектории рабочего органа. С помощью методик кинематического и динамического синтезов разработаны аналитические алгоритмы его перемещения по этим траекториям. Теоретические исследования апробированы на экспериментальном образце манипулятора гибридной структуры с актуаторами SKF CAHB-21. При этом ошибка позиционирования составляла не более 2 %, а отклонение фактических перемещений от заданных при наличии полезной нагрузки на захватном устройстве не превышало 5 %.

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

Похожие темы научных работ по механике и машиностроению , автор научной работы — Воробьева Н.С.

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

METHODS OF MANIPULATORS CONTROLLING BASED ON A TRIPOD WHEN PERFORMING TECHNOLOGICAL OPERATIONS

Parallel-serial (hybrid) structure manipulators are widely used in various sectors of the economy, which makes it possible to take into account the disadvantages and combine the advantages of manipulation systems of parallel and serial structures. Studies of technological processes have shown that they can be performed using manipulators of a parallel-serial structure based on a tripod, the features of which are not fully understood. Whereas it is important to choose a control system and control algorithms that depend on the characteristics of technological operations performed. Manipulator controlling is a complex task that includes positioning of the effector, planning and synthesis of trajectories, setting and moving the effector along a given trajectory. Each technological process can be described by a set of special trajectories, which can be entered in advance into the database of control models. The article formalizes the trajectories of the effector on the example of specific technological operations. Using the techniques of kinematic and dynamic synthesis, analytical algorithms for its movement along these trajectories have been developed. Theoretical studies were tested on the experimental sample of a hybrid structure manipulator with SKF CAHB-21 actuators. The experiments showed that positioning errors did not exceed 2%, and the deviation of the actual movements from the specified ones in the presence of a payload on the gripper did not exceed 5 %.

Текст научной работы на тему «МЕТОДЫ УПРАВЛЕНИЯ МАНИПУЛЯТОРАМИ НА БАЗЕ ТРИПОДА ПРИ ВЫПОЛНЕНИИ ТЕХНОЛОГИЧЕСКИХ ОПЕРАЦИЙ»

Машиностроение и машиноведение

УДК 621.865.8+62-503.5 doi: 10.18698/0536-1044-2022-3-3-14

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

Н.С. Воробьева

ФГБОУ ВО «Волгоградский государственный аграрный университет»

Methods of Manipulators Controlling Based on a Tripod When Performing Technological Operations

N.S. Vorobyeva

Volgograd State Agricultural University

Манипуляторы параллельно-последовательной (гибридной) структуры нашли широкое применение в различных отраслях экономики, что позволяет учесть недостатки и совместить достоинства манипуляционных систем параллельной и последовательной структур. Исследования технологических процессов показали, что их можно выполнять с помощью манипуляторов параллельно-последовательной структуры на основе трипода, особенности которых до конца не изучены. При этом важное значение имеет выбор системы и алгоритмов управления, зависящих от особенностей технологических операций. Управление манипулятором является комплексной задачей, включающей в себя позиционирование рабочего органа, планирование и синтез траекторий, перемещение рабочего органа по заданной траектории. Каждый технологический процесс можно описать набором специальных траекторий, которые можно заранее внести в базу моделей управления. На примере конкретных технологических операций формализованы траектории рабочего органа, с помощью методик кинематического и динамического синтезов разработаны аналитические алгоритмы его перемещения по этим траекториям. Теоретические исследования апробированы на экспериментальном образце манипулятора гибридной структуры с актуаторами SKF CAHB-21. Ошибка позиционирования составляла не более 2 %, а отклонение фактических перемещений от заданных при наличии полезной нагрузки на захватном устройстве не превышало 5 %.

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

Parallel-serial (hybrid) structure manipulators are widely used in various sectors of the economy, which makes it possible to take into account the disadvantages and combine the advantages of manipulation systems of parallel and serial structures. Studies of technological processes have shown that they can be performed using manipulators of a parallel-serial structure based on a tripod, the features of which are not fully understood. Whereas it is important to choose a control system and control algorithms that depend on the characteristics of technological operations performed. Manipulator controlling is a complex task that includes positioning of the effector, planning and synthesis of trajectories, setting and mov-

ing the effector along a given trajectory. Each technological process can be described by a set of special trajectories, which can be entered in advance into the database of control models. The article formalizes the trajectories of the effector on the example of specific technological operations. Using the techniques of kinematic and dynamic synthesis, analytical algorithms for its movement along these trajectories have been developed. Theoretical studies were tested on the experimental sample of a hybrid structure manipulator with SKF CAHB-21 actuators. The experiments showed that positioning errors did not exceed 2%, and the deviation of the actual movements from the specified ones in the presence of a payload on the gripper did not exceed 5 %.

Keywords: manipulators based on a tripod, parallel-serial structure, controlled capture, control methods

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

В связи с этим эффективно использовать манипуляторы параллельно-последовательной (гибридной) структуры, сочетающие в себе достоинства двух структур: повышенные показатели по грузоподъемности, точности, быстродействию, а также достижения в области достаточно большой протяженности [4, 5].

Ученые Института машиноведения им. А.А. Благонравова РАН, занимавшиеся исследованиями параллельных и параллельно-последовательных структурных схем, получили значительные результаты в этой области. Разработана полная классификация этих механизмов, созданы методы их анализа и синтеза, исследованы их динамические свойства. Все это нашло отражение в работах А.Ф. Крайнева, В.А. Глазунова, В.М. Базрова, А.И. Корендясева, Г.В. Рашояна, Б.Л. Саламандры, Ю.А. Семенова, Л.И. Тывеса, С.В. Хейло, Г.С. Филиппова и др. [5-8]. Вместе с тем проблемы проектирования и расчета параметров, моделирования кинематики и динамики манипуляторов подобной структуры окончательно не сформированы.

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

Рассмотрим особенности управления манипуляторами параллельно-последовательной структуры на примере технологических операций, применяемых в сельском хозяйстве. Так

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

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

Специалисты Волгоградского государственного аграрного университета много лет исследуют такие механизмы. Разработаны, запатентованы и изготовлены экспериментальные образцы манипуляционных механизмов на базе трипода с тремя-шестью степенями свободы характерной токи M рабочего органа (РО) и разными видами движения основания ABC:

• с неподвижным (рис. 1, а) — манипулятор-трипод промышленного назначения (патент РФ 26511781);

• с вращательным (рис. 1, б) — манипулятор-трипод параллельно-последовательной структуры (патент РФ 2616493);

• с плоскопараллельным (рис. 1, в) — робот-погрузчик сеток с овощами (патент РФ 22247);

• со сложным (рис. 1, г) — аварийно-спасательная машина (патент РФ 2476372).

Эти технические решения можно использовать для погрузочно-разгрузочных работ пакетированных грузов; перемещения легких штучных грузов с одного конвейера на другой или с конвейера в контейнер (бункер); для сбора, фертигации и опрыскивания плодов; сортировки плодов овощей и фруктов; чеканки плодовых деревьев и кустарников при условии применения сменного РО и для работы в экстремальных условиях.

С

в г

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

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

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

Схема обрезки винограда, где в качестве манипулятора для робота-чеканщика применен манипулятор-трипод с трехстепенным управляемым захватным устройством (см. рис. 1, а) приведена на рис. 2, а. Схема обрезки лоз с од-

ной стороны шпалеры изображена на рис. 2, б, где в точках 1 и 2 происходит срез лоз куста винограда.

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

Манипулятор-трипод с захватным устройством (рис. 3) состоит из трех исполнительных звеньев в виде электрических актуаторов с линейными приводами. С одного конца звенья li, ¡2, 1з закреплены на поворотном треугольном основании-платформе ABC, с другого соединены в точке M и смонтированы на сферическом шарнире с пятью степенями подвижности.

Так как звено ¡4 с помощью линейного акту-атора может изменять свою длину, угол поворота ф основания ABC также имеет переменные

ь- —\

I

2500...3000

1

/ 1

Рис. 2. Схемы обрезки винограда манипулятором-триподом с трехстепенным управляемым

захватным устройством (а) и обрезки лоз с одной стороны шпалеры (б): 1,2, 3 — перемещение РО по прямой, изогнутой в виде параболы и ломаной кривой соответственно

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

Манипуляционная схема с наклонным основанием и дополнительно установленным за-

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

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

параметры в функции времени Р. длины исполнительных звеньев руки Р), к = 1, 2, 3; угол ф(Р) наклона поворотного основания; углы относительных поворотов а(Р), ^(Р) звеньев захватного устройства и угол поворота кисти Р(Р). Значения углов определяют параметры манипуля-тивности манипулятора-трипода (см. рис. 3).

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

систем координат: абсолютная Охуг, связанная с неподвижным основанием, и подвижные Огхут (г = 1, 2, 3, 4), соответствующие каждому звену манипулятора (см. рис. 3).

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

Основные перемещения РО манипулятора

Описание перемещения РО

Схема перемещения РО

Перемещение РО из исходного положения в положение начала выполнения технологического процесса

Вертикальное поступательное прямолинейное движение РО вдоль оси z с не вращающимся захватным устройством: а = const, ^ = const, Р = 0 или P(t), XE = const, XM = const, yE = const, yM = const, q5 = zM(t)

Горизонтальное поступательное прямолинейное движение РО вдоль оси x с не вращающимся захватным устройством: ^(t) = -y(t), а = const, Р = 0 или P(t), xE = const, yE(t), zE = const, xM = const, yM(t), zM = const

Прямолинейное движение РО 5 (х, г) под углом в вертикальной плоскости Х тТ при неизменной конфигурации манипулятора

S(x, z)

Движение РО по заданной траектории Б(х,г) в вертикальной плоскости Х тТ при неизменной конфигурации манипулятора

Прямолинейное движение РО 5 (х, у) под углом в горизонтальной плоскости х у при неизменной конфигурации манипулятора

Окончание таблицы

Описание перемещения РО

Схема перемещения РО

Движение РО по заданной траектории Б(х,у) в горизонтальной плоскости х'У при неизменной конфигурации манипулятора

Движение РО по произвольной заданной траектории §(х,у,г) при неизменной конфигурации манипулятора с тремя управляемыми степенями свободы

Ориентация в пространстве манипулятора при неподвижной точке крепления РО к манипулятору последовательной структуры

Замена РО

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

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

На первом этапе необходимо решить задачу позиционирования манипулятора-трипода: определить обобщенные координаты 1к (к = 1, 2, 3), ф, а, ^ и Р при заданном программном положении РО. Положение РО определяется конечными координатами (хв, уж, гВ) характерной точки В захватного устройства в абсолютной системе координат Охуг и направляющих коси-

нусов ам подвижной системы координат Охуг относительно абсолютной Охуг (см. рис. 3).

Для этого необходимо решить прямую задачу для трипода — определить декартовы координаты точки М(хм, ум, гм) в абсолютной системе координат Охуг — и обратную задачу для захватного устройства — найти обобщенные координаты углов а, ^ и р. Решение этой задачи носит оптимизационный характер [9].

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

Один из тривиальных способов решения этой задачи — выбор для каждой обобщенной координаты известного закона изменения ускорения: прямоугольного, линейного, синусоидального, полиноминального и др. Такой способ решения задачи управления можно использовать, если на траектории РО нет препятствий, так как траектория характерной точки М заранее неизвестна.

Закон изменения обобщенных координат определим в постановке слабого терминального управления. Считаем, что для каждого исполнительного звена известны контуры управле-

ния, замкнутые по обобщенным координатам 1к (), к = 1, 2, 3, 4.

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

Принимаем, что на траектории РО отклонения от конечного состояния исполнительных звеньев

Мк (г) = ¡0 - 1к (г)

изменяются по дифференциальному уравнению

А ¡к(г) + а^Мк (г) + ак 2 Д4 (г) + ак 3 Мк (г) = 0, (1)

где ¡0 — конечное значение обобщенных координат исполнительных звеньев; ак1, ак2, ак3 — постоянные положительные числа.

Уравнение (1) позволяет определить законы движения РО без скачков ускорений в начальной и конечной точках траектории [10]. Закон изменения длин звеньев от времени является программным:

Тк (г) = -ак1 ¡к (г) - ак24 (г) + ак3 [¡0 - ¡к (г)]. (2)

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

Чтобы реализовать конкретные технологические процессы, необходимо перемещать РО манипулятора-трипода по заданной программной траектории с заданной ориентацией РО. На этом этапе траекторию исполнительного звена привода заменяют набором специальных траекторий (сплайнов), в связи с чем рассмотрены два метода кинематического синтеза, основанных на дискретизации траектории.

Определение законов изменения длин акту-аторов и углов звеньев захватного устройства осуществляется следующим образом: заданную траекторию точки В разбивают на п участков, определяют конфигурацию манипулятора в каждой точке, т. е. находят значения обобщенных координат ¡к (г;) а(г;) и ).

При использовании первого метода кинематического синтеза необходимо решить две подзадачи: рассчитать коэффициенты сплайна и провести аппроксимацию значений функции в заданные моменты времени [11]. Чтобы выполнялись требования по границам, необходимо проинтерполировать полиномами четвертого порядка первый и последний отрезки траектории:

9; (т) = Л;4 х4 + А^т3 + Л;2 х2 + ЛцХ + Лю, (3)

где 9; (т) — обобщенная координата манипу-лятора-трипода, представляющая собой функцию времени т на ;-м участке изменения функции; т — безразмерное время, т = г/Тг (Тг — время перемещения на г-м участке), 1 >т> 0; Лг4,..., Л;0 — коэффициенты полинома.

Для промежуточного участка закона изменения 9; (т) на г-м участке изменения функции получаем полином третьего порядка

9; (т) = + А;э т3 + Аа т2 + Лг1т + Л;„. (4)

С помощью полиномов третьего (3) и четвертого (4) порядка выводим функцию времени изменения длин и углов исполнительных звеньев.

При использовании второго метода кинематического синтеза аналитических зависимостей законов изменения исполнительных звеньев от времени полученные значения обобщенных координат манипулятора-трипода ¡к (г;), а(г;), ) аппроксимируют полиномом степени т на множестве значений ¡к; (г;) в интервале времени от = Аг до гп-1 = (п -1)Дг:

Ок (г) = А0к + лиг+Л2кг2 +... + Лткгт, (5)

где Д£ — шаг приращения времени; Лтк — постоянные коэффициенты полиномов, определяемые из условия минимума функции в виде квадратичного отклонения [12]

8 = £[к (г;) — ¡к; (ь )]2. (6)

;=1

Чтобы удовлетворить граничным условиям по положению, скорости и ускорению захватного устройства, в интервалах времени от г0 = 0 до =Дг и от гп-1 = (п -1)Дг до гп = пДг искомую функцию перемещения исполнительного звена интерполируем полиномами пятого порядка

Pk (t) - B5kt5 + B4kt4 + B3kt3 + B2kt2 + Bikt + Bok

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

при At > t > 0; Hk (t) - C5kt5 + C4kt4 + C3kt3 + C2kt2 + Clkt + Cok при tn > t > tn-1,

(7)

где Bsk,..., Bok, C5k,..., Cok — коэффициенты полиномов.

Для первого отрезка подставляем значения t = 0, ti = At и для последнего отрезка — tn-i = (n - l)Aí, tn = nAt на левом и правом концах соответственно. Из системы полученных уравнений находим коэффициенты полиномов (7).

Таким образом, полиномы (4) и (7) полностью определяют аналитические законы изменения длин исполнительных цилиндров непрерывными функциями времени

lk (t) -

Pk (t) при i > t > 0; Qk (t) при 11 > t > 1; Hk (t) при 12 > t > 11,

k -1, 2, 3, 4.

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

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

Метод динамического синтеза законов перемещения звеньев используют для определения законов формирования управляющих сил Рк(Р) и моментов Т¥(Р), Та(р), Тр(р), обеспечивающих перемещение РО в заданное положение за заданное время по программной траектории. Для решения этой задачи составляют

математическую модель динамики движения манипуляционного механизма.

Обобщенными координатами являются параметры, которые описывают конфигурацию манипулятора-трипода и состояние трехзвен-ного захватного устройства: qi = ф, q2 = у, q3 = Xm, q4 = yM, qs = Zm, qe = a, q? = y, q8 = P. При этом число независимых обобщенных координат равно семи (см. рис. 3).

Динамическая характеристика привода, состоящего из двигателя постоянного тока, необратимого редуктора и шариковинтовой передачи, имеет вид

+ F = ruj - slj,

где ц — электромагнитная постоянная времени; F — усилие на штоке исполнительного звена; r, s — коэффициенты, зависящие от параметров двигателя и механической передачи; u — управляющее напряжение; Ъ — скорость штока исполнительного звена.

Характеристики приводов поворота звеньев захватного устройства имеют подобный вид.

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

T -1

2

A11 A12 A21 A22

As1 As2

A18 A28

Ass

q1 qq

<M1 q2

qsq1 q?8 q?2

qq q2qs

где Ask - Aks — коэффициенты матрицы, зависящие от обобщенных координат, s -1, 2,..., 8, k - 1,2,..., 8 [13].

Потенциальная энергия системы

n(qk) - mAg\OA\cosф + (М + mw )gZM +

+ [m2lc 2 + (m3 + m4 + mw )a + + (m3lc 3 + m4lc 4 + mWlcW )cos ^ ] g sin a,

где mA — приведенная масса поворотного основания ABC; g — ускорение свободного падения; М — приведенная масса манипулятора; mw — масса переносимого груза; m2, m3 и m4 — массы звеньев захвата; lc2, lc3, lc4 и lw — расстояние до центра масс звеньев захвата и груза соответственно.

Движение манипулятора параллельно-последовательной структуры описывается уравне-

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

8 8 8

Е Азк'с^к + Е Е [к, m, я] 44 —

k —1 к —1 ш=1 = + , з = 1,2.....8. (8)

Здесь Qs — обобщенная сила; X — множитель Лагранжа; ЭП/Э^ — обобщенная сила потенциальных активных сил; [к, ш, я] — символы Кристоффеля первого рода,

|- -| = 1 (ЭАкз ^ ЭА-тз ЭАкш ^

I к, ш, я I ——--1 I,

2 ^ Э4ш Э4к Э^ ) где частные производные вычисляются с помощью программы символьной математики.

Используя уравнения Лагранжа второго рода (8) с голономными связями [13, 14], получают восемь дифференциальных уравнений, описывающих динамику движения манипулятора-трипода вместе с захватным устройством [15]. Решая эти уравнения при известных законах перемещения захватного устройства, находят движущие силы ¥к (£), к = 1, 2, 3, 4 и моменты Т^), Та(£), Тр(£), обеспечивающие выполнение необходимого программного движения для выполнения технологического процесса. Результаты расчетов используются для выбора приводных электродвигателей, а также служат исходными данными для проектирования системы управления.

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

Рис. 4. Внешний вид экспериментального образца манипулятора-трипода с актуаторами БКБ САНВ-21

разце манипулятора-трипода с актуаторами БКБ САНВ-21 и управляемым захватным устройством (рис. 4). При этом ошибка позиционирования составляла не более 2 %, а отклонение фактических перемещений от заданных при наличии полезной нагрузки на захватном устройстве не превышало 5 %.

При экспериментальном моделировании использованы те же начальные условия и конфигурация исследуемого манипулятора-трипо-да, что и при численном исследовании. Сравнение расчетных и экспериментальных зависимостей длин и управляющих напряжений звеньев манипулятора-трипода от времени (рис. 5, а, б) проведено при движении захватного устройства из начальной точки с координатами хе0 = -77 мм, уе0 = 1129 мм, ге0 = 650 мм в конечную точку хек = 168 мм, уек = 1371 мм, гек = -167 мм.

/, мм

и, В

2 Г ^

2'^

3 3 .г^ /

4

10 и с

-10

Рис. 5. Расчетные (1-4) и экспериментальные (1'-4') зависимости длин I (а) и управляющих напряжений и (б) первого (1, 1'), второго (2, 2'), третьего (3, 3') и четвертого (4, 4') звеньев манипулятора-трипода от времени £

Как видно из рис. 5, а и б, максимальное расхождение теоретических и экспериментальных данных не превышает 10 %, что свидетельствует об адекватности предложенной математической модели.

Выводы

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

2. Кинематические методы синтеза аналитических зависимостей законов изменения исполнительных звеньев от времени позволяют сформировать задающий сигнал для каждого

Литература

звена манипулятора-трипода и спроектировать позиционно-траекторную систему управления с обратными связями по положению и скорости, позволяющую отслеживать программные траектории.

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

[1] Бушуев В.В., Хольшев И.Г. Механизмы параллельной структуры в машиностроении.

СТИН, 2001, № 1, с. 3-8.

[2] Merlet J.P. Parallel Robots. Norwell, Kluwer Acad. Publ., 2000. 372 p.

[3] Филиппов Г.С. Кинематический анализ механизма параллельно-последовательной

структуры с пятью степенями свободы. Известия высших учебных заведений. Машиностроение, 2019, № 8, с. 18-24, doi: http://dx.doi.org/10.18e98/0S3e-1044-2019-8-18-24

[4] Liu N., Wu J. Kinematics and application of a hybrid industrial robot Delta-RST. Sens.

Transducers, 2014, vol. 169, no. 4, pp. 186-192.

[5] Glazunov V., Filippov G., Rashoyan G., Gavrilina L., Shalyukhin K., Skvortsov S. Analysis of

mechanisms with parallel-serial structure S-DOF and extended working area. Smart Innovation, Systems and Technologies, 2022, vol. 232, pp. 3-12, doi: https://doi.org/10.1007/978-981-16-2814-6_1

[6] Хейло С.В., Глазунов В.А., Палочкин С.В. Манипуляционные механизмы параллельной

структуры. Структурный синтез. Кинематический и силовой анализ. Москва, МГТУ им. А.Н. Косыгина, 2011. 1S3 с.

[7] Antonov A., Fomin A., Glazunov V., Kiselev S., Carbone G. Inverse and forward kinematics

and workspace analysis of a novel S-dof (3t2r) parallel-serial (hybrid) manipulator. International Journal of Advanced Robotic Systems, 2021, vol. 18 (2), doi: https://doi.org/ 10.1177/1729881421992963

[8] Глазунов В.А., Филиппов Г.С., Петраков А.А. и др. Разработка новых механизмов для

современных робототехнических систем, предназначенных для технологических, медицинских, аддитивных и диагностических устройств. В: Новые механизмы в современной робототехнике. Москва, Техносфера, 2018, с. 131-143.

[9] Жога В.В., Дяшкин-Титов В.В., Несмиянов И.А. и др. Задача позиционирования мани-

пулятора параллельно-последовательной структуры с управляемым захватным устройством. Мехатроника, автоматизация, управление, 2016, т. 17, № 8, с. 525-S30, doi: https://doi.org/10.17587/mau.17.525-530

[10] Воробьева Н.С. Стабилизация пространственного положения манипулятора параллельно-последовательной структуры. Известия ВолгГТУ, 2021, № 9, с. 17-21. URL: https://doi.org/10.35211/1990-5297-2021-9-256-17-21

[11] Vorob'eva N.S., Nesmiyanov I.A., Zhoga V.V. Program displacement tracing of executive devices by the manipulator drives of parallel-sequential structures. J. Comput. Syst. Sci. Int., 2019, vol. 58, no. 2, pp. 305-316, doi: https://doi.org/10.1134/S1064230719020187

[12] Vorob'eva N.S., Zhoga V.V., Nesmiyanov I.A. et al. Kinematic synthesis of programmed motions of drivers of a manipulator-tripod with a three-degree gripper. In: Advances in mechanical engineering. Springer, 2019, pp. 73-82, doi: https://doi.org/10.1007/978-3-030-11981-2_7

[13] Воробьева Н.С., Дяшкин-Титов В.В., Жога В.В., Несмиянов И.А. Динамика манипулятора параллельно-последовательной структуры на основе трипода. Машиностроение и инженерное образование, 2017, № 3, с. 32-41.

[14] Zhoga V., Gavrilov A., Gerasun V. et al. Walking mobile robot with manipulator-tripod. In: Advances on theory and practice of robots and manipulators. Springer, 2014, pp. 463-471, doi: https://doi.org/10.1007/978-3-319-07058-2_52

[15] Воробьева Н.С., Жога В.В., Жога Л.В. Динамический синтез алгоритмов управления манипулятором параллельно-последовательной структуры. Мехатроника, автоматизация, управление, 2020, т. 21, № 12, с. 706-715. URL: https://doi.org/10.17587/ mau.21.706-715

References

[1] Bushuev V.V., Khol'shev I.G. Mechanisms of parallel structure in machine building. STIN,

2001, no. 1, pp. 3-8. (In Russ.).

[2] Merlet J.P. Parallel Robots. Norwell, Kluwer Acad. Publ., 2000. 372 p.

[3] Filippov G.S. Kinematic analysis of a parallel-sequential structure mechanism with five de-

grees of freedom. Izvestiya vysshikh uchebnykh zavedeniy. Mashinostroenie [BMSTU Journal of Mechanical Engineering], 2019, no. 8, pp. 18-24, doi: http://dx.doi.org/10.18698/ 0536-1044-2019-8-18-24 (in Russ.).

[4] Liu N., Wu J. Kinematics and application of a hybrid industrial robot Delta-RST. Sens.

Transducers, 2014, vol. 169, no. 4, pp. 186-192.

[5] Glazunov V., Filippov G., Rashoyan G., Gavrilina L., Shalyukhin K., Skvortsov S. Analysis of

mechanisms with parallel-serial structure 5-DOF and extended working area. Smart Innovation, Systems and Technologies, 2022, vol. 232, pp. 3-12, doi: https://doi.org/10.1007/978-981-16-2814-6_1

[6] Kheylo S.V., Glazunov V.A., Palochkin S.V. Manipulyatsionnye mekhanizmy parallel'noy

struktury. Strukturnyy sintez. Kinematicheskiy i silovoy analiz [Handling mechanisms of parallel structure. Structure synthesis. Kinematic and force analysis]. Moscow, MGTU im. A.N. Kosygina Publ., 2011. 153 p. (In Russ.).

[7] Antonov A., Fomin A., Glazunov V., Kiselev S., Carbone G. Inverse and forward kinematics

and workspace analysis of a novel 5-dof (3t2r) parallel-serial (hybrid) manipulator. International Journal of Advanced Robotic Systems, 2021, vol. 18 (2), doi: https://doi.org/ 10.1177/1729881421992963

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

[8] Glazunov V.A., Filippov G.S., Petrakov A.A. et al. Razrabotka novykh mekhanizmov dlya

sovremennykh robototekhnicheskikh sistem, prednaznachennykh dlya tekhnologicheskikh, meditsinskikh, additivnykh i diagnosticheskikh ustroystv [Development of new mechanisms for modern technological, medical, additive and diagnostic devices]. V: Novye mekhanizmy v sovremennoy robototekhnike [In: New mechanisms in modern robotics]. Moscow, Tekhnosfera Publ., 2018, pp. 131-143. (In Russ.).

[9] Zhoga V.V., Dyashkin-Titov V.V., Nesmiyanov I.A. et al. Manipulator of a parallel-series

structure with a controlled gripper positioning task. Mekhatronika, avtomatizatsiya, uprav-lenie [Mechatronics, Automation, Control], 2016, vol. 17, no. 8, pp. 525-530, doi: https://doi.org/10.17587/mau.17.525-530 (in Russ.).

[10] Vorob'yeva N.S. Stabilization of the spatial position of the manipulator of a parallel-sequential

structure. Izvestiya VolgGTU [Izvestia Volgograd State Technical University], 2021, no. 9, pp. 17-21. URL: https://doi.org/10.35211/1990-5297-2021-9-256-17-21 (in Russ.).

[11] Vorob'eva N.S., Nesmiyanov I.A., Zhoga V.V. Program displacement tracing of executive devices by the manipulator drives of parallel-sequential structures. J. Comput. Syst. Sci. Int., 2019, vol. 58, no. 2, pp. 305-316, doi: https://doi.org/10.1134/S1064230719020187

[12] Vorob'eva N.S., Zhoga V.V., Nesmiyanov I.A. et al. Kinematic synthesis of programmed motions of drivers of a manipulator-tripod with a three-degree gripper. In: Advances in mechanical engineering. Springer, 2019, pp. 73-82, doi: https://doi.org/10.1007/978-3-030-11981-2_7

[13] Vorob'yeva N.S., Dyashkin-Titov V.V., Zhoga V.V., Nesmiyanov I.A. The dynam-ics of the parallel-serial manipulator based on the tripod. Mashinostroyeniye i inzhenernoye obra-

zovaniye [Mechanical Engineering and Engineering Education], 2017, no. 3, pp. 32-41 (in Russ.).

[14] Zhoga V., Gavrilov A., Gerasun V. et al. Walking mobile robot with manipulator-tripod. In: Advances on theory and practice of robots and manipulators. Springer, 2014, pp. 463-471, doi: https://doi.org/10.1007/978-3-319-07058-2_52

[15] Vorob'yeva N.S., Zhoga V.V., Zhoga L.V. Dynamic synthesis of parallel-sequential structure manipulator control algorithms. Mekhatronika, avtomatizatsiya, upravlenie [Mechatronics, Automation, Control], 2020, vol. 21, no. 12, pp. 706-715. URL: https://doi.org/10.17587/ mau.21.706-715 (in Russ.).

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

ВОРОБЬЕВА Наталья Сергеевна — кандидат технических наук, доцент, зав. кафедрой «Механика». ФГБОУ ВО «Волгоградский государственный аграрный университет» (400002, Волгоградская обл., Волгоград, Российская Федерация, пр. Университетский, д. 26, e-mail: vgsxa@mail.ru).

Статья поступила в редакцию 27.12.2021 Information about the author

VOROB'EVA Natalya Sergeevna — Candidate of Science (Eng.), Associate Professor, Head of the Department of Mechanics. Federal State Budgetary Educational Institution of Higher Education «Volgograd State Agricultural University» (400002, Volgograd, Universitetskiy Ave., 26, e-mail: vgsxa@mail.ru ).

Издательство МГТУ им. Н.Э. Баумана предлагает читателям сборник материалов III Межвузовской конференции аспирантов, соискателей и молодых ученых

«Наука, технологии и бизнес»

В сборник вошли тезисы докладов и сообщений на английском и русском языках, сделанные на III Межвузовской конференции аспирантов, соискателей и молодых ученых, состоявшейся 27-28 апреля 2021 г.

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

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

105005, Москва, 2-я Бауманская ул., д. 5, к. 1. Тел.: +7 499 263-60-45, факс: +7 499 261-45-97; press@baumanpress.ru; https://bmstu.press

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

Воробьева Н.С. Методы управления манипуляторами на базе трипода при выполнении технологических операций. Известия высших учебных заведений. Машиностроение, 2022, № 3, с. 3-14, doi: 10.18698/05361044-2022-3-3-14

Please cite this article in English as: Vorobyeva N.S. Methods of Manipulators Controlling Based on a Tripod When Performing Technological Operations. BMSTU Journal of Mechanical Engineering, 2022, no. 3, pp. 3-14, doi: 10.18698/0536-1044-2022-3-3-14

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