umk-teoriya-mehanizmov
.pdf9.2. Основные технические характеристики манипуляторов
Основная характеристика – число степеней подвижности. Это число можно разбить на [22] глобальные, локальные и местные подвижности.
Глобальные обеспечиваются за счет транспортных средств, на кото- рых установлен манипулятор.
Локальные – те, которыми обладает «рука» манипулятора в системе транспортного средства (W = ∑Wi ).
Местные обеспечиваются за счет конкретных кинематических пар, соединяющих «руку» и переносящую ее кинематическую цепь (Wi ).
Маневренность – подвижность кинематической цепи при закреплен- ной «руке». В пространстве М = W − 6 , а в плоскости М = W − 3 . Маневренность определяет количество способов обхода «рукой» препятствий. Маневренность используют для оптимизации параметров работы манипулятора (траектории и энергопотребления).
|
Рабочий объем – |
часть пространства |
||||
в |
пределах |
теоретической |
досягаемости |
|||
руки |
манипулятора |
при |
неподвижном |
|||
транспортном средстве. Для манипулято- |
||||||
ра |
на |
рис. |
9.1 это сфера |
радиусом |
||
r = l1 + l2 + l3 , описанная около центра О. |
||||||
|
Зона обслуживания – |
часть рабоче- |
||||
го объема, фактически обслуживаемая |
||||||
схватом «рукой» с учетом конструкции |
||||||
кинематических пар. Пример – |
рука чело- |
века (рабочий объем – шар, зона обслу- живания – полушар).
Угол и коэффициент сервиса – не
Рис. 9.1. Универсальный
во всякой точке зоны обслуживания «ру-
манипулятор
ка» манипулятора может располагаться всеми возможными способами от- носительно этой точки. При любой степени подвижности и маневренности существует телесный угол Q, в пределах которого это возможно. Телесный угол можно определить площадью сферы единичного радиуса, описывае- мой схватом манипулятора из точки К (рис. 9.2). На границах зоны обслу- живания указанный угол равен нулю. Величина этого угла называется уг- лом сервиса, а отношение угла сервиса к полному его значению (4π) назы-
вается коэффициентом сервиса Q* = Q / 4π . Среднее значение коэффициен- та сервиса в рабочем объеме V:
Qср* . = V1 V∫Q* × dV .
131
Рис. 9.2. Манипулятор и угол сервиса
Названные показатели задают и используют для проектирования схем манипуляторов и выбора их размеров.
Степень подвижности выбирают в зависимости от задач, поставлен- ных перед манипулятором. Степень подвижности, равная трем, позволяет руке достигать любую точку зоны обслуживания. При степени подвижно- сти, равной двум, движение может осуществляться лишь в плоскости.
Маневренность назначают для оптимизации параметров работы ма- нипулятора (оптимизация траекторий и энергопотребления путем оптими- зации рабочих нагрузок).
9.3.Синтез манипулятора промышленного робота по размерам
иформе зоны обслуживания
Промышленные манипуляторы применяются для выполнения огра- ниченных функций руки человека. Их оптимальная степень подвижности равна трем. Соответственно, они содержат три низшие кинематические па- ры, приводимые в движение от простейших промышленных двигателей со степенью подвижности W = 1. Это – электромагниты, гидро- и пневмоци- линдры, линейные и шаговые электродвигатели и т.п. Команды на их управление поступают от ЭВМ.
У трехподвижных манипуляторов возможны 4 комбинации поступа- тельных (П) и вращательных (В) низших кинематических пар – ППП,
132
ВПП, ВВП и ВВВ. Каждой комбинации соответствует своя форма зоны обслуживания (рис. 9.3 – 9.6).
l2
c(t) l3
cmax
l1
amax
Рис. 9.3. Манипулятор ППП и его зона обслуживания
с(t)
φ(t)
b(t)
цилиндр
Рис. 9.4. Манипулятор ВПП и его зона обслуживания
cmax
cmax
|
|
|
|
|
сфера |
|
|
|
|
|
|
|
φ2 |
(t) |
|
|
|
|
|
|
|
φ1max
φ2max
Рис. 9.5. Манипулятор ВВП и его зона обслуживания
133
l1
l2
сфера
φ1max
φ2max
Рис. 9.6. Манипулятор ВВВ (шарнирный) и его зона обслуживания
Синтез описанной группы манипуляторов сводится к тому, чтобы за счет выбора длин соответствующих звеньев и возможностей движения в кинематических парах обеспечить досягаемость задаваемых зон обслужи- вания. Например, для манипулятора ППП на рис. 9.3 должно быть
l1 ³ amax , l2 ³ bmax , l3 ³ cmax .
9.4. Синтез манипулятора по коэффициенту сервиса
Универсальный манипулятор (рис. 9.7) имеет W = 7 и М = 1.
Рис. 9.7. Схема универсального манипулятора
Пусть длины звеньев:
l1 > l2 > l3 l1 > l2 + l3
Рабочий объем между сферами радиусов:
Rmin = l1 − l2 − l3 . |
(9.1) |
Rmax = l1 + l2 + l3 |
|
x a m R
Rmin
Рабочий объем
C
L-опорная плоскость
Рис. 9.8. Рабочий объем универсального манипулятора
Рис. 9.9. Изменение проворачиваемости φmax схвата в опорной плоскости
Если звено АВ в какой-либо точке на прямой АС является кривоши- пом, то этот кривошип в указанной точке будет иметь возможность опи- сать телесный угол 4π (2π в опорной плоскости и 2π вокруг прямой АС). При этом θ = 4π . У границ же рабочего объема станет θ = 0.
В точках неполного сервиса угол сервиса Q по определению
Q = F′ ,
l32
где F′ – площадь части сферы, которую описывает из точки А звено l3.
Пример синтеза
Дано: размеры рабочего объема Rmax = 1200 мм, Rmin = 300 мм. Зона неполного сервиса b = 200 мм (звено АВ не проворачивается).
Найти: l1 , l2 , l3 .
Решение
Складывая уравнения (9.1), получим:
l = |
Rmax + Rmin |
= |
1200 + 300 |
= 750мм. |
|
|
|||
1 |
2 |
2 |
|
|
|
|
Кроме того:
b = 2l3 = 200мм,
отсюда:
l3 = 100мм; l2 = Rmax − l1 − l3 = 1200 − 750 −100 = 350мм.
135
9.5.Способы передачи движения через шарниры
Втехнике передача движения через кинематические пары может вы- зывать сложности. Рассмотрим некоторые примеры решения таких задач.
Шаровой шарнир (рис. 9.10, а) можно заменять кинематическим со- единением, позволяющим применить существующие двигатели простей- шей конструкции (с одной степенью свободы). При этом необходимо со- хранить степень подвижности заменяющей цепи.
Кинематическое соединение есть кинематическая цепь со степенью подвижности заменяемой цепи.
z |
W = 3 |
|
|
x
y
z
Рис. 9.10. Замена шаровой пары кинематическим соединением: а) шаровая пара; б) кинематическое соединение
При подвижности кинематической пары W = 2 можно применить червячную передачу (рис. 9.11, а), либо коническую с круговым зубом
(рис. 9.11, б).
а) |
б) |
Рис. 9.11. Механизм для передачи сферического движения: а) червячная передача; б) конические и гипоидные передачи
136
В руке человека движение через шарниры (цилиндрические и шаро- вые), передают мышцы при их сокращении. Каждая связана с системой управления – головным мозгом человека.
9.6. Кинематика манипулятора промышленного робота. Прямая и обратная задачи
Средствами кинематики решаются прямая и обратная задачи [23], т.е.:
1)задача о позиционировании: известны обобщенные координаты φ1, φ2, и т.д. Требуется найти положение схвата X, Y, Z;
2)задача об управлении (обратная задача). Найти обобщенные коор- динаты φ1, φ2, и т.д., если известны координаты схвата X, Y, Z.
Обобщенные координаты изменяются по программам, заложенным в устройство управления, а исполнительными органами являются различные двигатели (шаговые, постоянного тока, пневматические и др.)
Наиболее просто вопросы кинематики решаются для промышленных роботов, степень подвижности которых – не более трех. Рассмотрим пример. На рис. 9.12 изображен трехподвижный манипулятор ПВП промышленного робота; x(t), z(t), и φ(t) – его обобщенные координаты, а XE(t), YE(t), и ZE(t) – координаты точки Е схвата в декартовой системе. Из рис. 9.12 имеем:
ZE = z(t)
X E = x(t) ×sin j(t)
YE = y(t) × cos j(t)
z
повернуто
φ(t)
Рис. 9.12. Трехподвижный манипулятор промышленного робота
137
Дифференцируя XE, YE, ZE по t, находим проекции скоростей схвата на оси координат.
Координаты XE, YE, и ZE схвата в других схемах манипуляторов про- мышленных роботов находят аналогично.
Так решается прямая задача.
Обратная задача обычно решается слож- нее: пусть требуется для схемы (рис. 9.12) обеспечить движение схвата по прямой АС (рис. 9.13). Предположим, что прямая АС рас- положена горизонтально. Тогда z(t) = const.
Уравнение прямой АС представим в нормальной форме:
|
|
|
|
y ×sin a + x × cos a - h = 0 , |
||||
|
|
где |
h и α – |
длина нормали и ее угол с |
||||
Рис. 9.13. Манипулятор ВПП, |
осью х; S(t) – |
известная функция положения |
||||||
схвата на прямой АС. |
||||||||
направляющий по прямой АС |
||||||||
|
|
Обобщенные координаты X(t) и φ(t) |
||||||
|
|
|
|
|||||
находим из треугольника ВЕТ: |
|
|
|
|
|
|
||
|
|
|
j(t) = arctg |
S (t) |
. |
|||
x(t) = S (t)2 + h2 , |
||||||||
|
||||||||
|
|
|
|
|
|
h |
9.7. Кинематика манипулятора по методу преобразования координат [24]
Предварительнo рассмотрим вопросы преобразования вектора.
Вектор la в системе координат «а» можно представить так: la = ia × X + ja ×Y + ka × Z ,
где X, Y, Z – проекции вектора la на оси системы «а»,
i , j , k – единичные орты этой системы.
Проекция вектора la на ось X системы « b » вычисляется как: laxb = ib ×ia ×X + ib × ja ×Y + ib × ka × Z .
Преобразование вектора la |
из системы « а» в систему « b » можно |
|||||||||
выразить произведением матриц: |
|
|
|
|
|
|||||
|
laxb |
|
X |
|
(ib ×ia ), |
(ib × ja ), |
(ib × ka ) |
|
x |
|
|
|
|
|
|
||||||
|
layb |
= |
Y |
´ |
( jb ×ia ), |
( jb × ja ), |
( jb × ka ) |
= |
y |
´ Mab , |
|
l |
|
Z |
|
(kb ×ia ), |
(kb × ja ), (kb × ka ) |
|
z |
|
|
|
azb |
|
|
|
|
|
|
|
|
|
где ib ×ia , ib × ja |
и т.д. – направляющие косинусы осей системы «b» в осях |
системы «а», а Mab – матрица перехода из системы «b» в систему «а».
138
Рассмотрим кинематику универсального манипулятора (рис. 9.14).
Z0 |
|
ϕ7 |
ϕ |
Z2 |
|
|
|
6 |
|
Z1 |
ϕ4 |
|
ϕ5 |
l3 |
|
|
|
||
ϕ2 |
l2 |
|
C |
|
|
|
|||
|
|
|
|
|
A |
ϕ3 |
|
|
|
l1 |
lc |
|
Z3 |
|
|
|
|
|
|
|
ϕ1 |
|
|
|
|
O |
X0 |
|
|
Y0
Рис. 9.14. Кинематика универсального манипулятора
Обозначим: M10, М20 и М30 – матрицы перехода (поворота) из систе- мы координат, связанной с рассматриваемым звеном, в систему абсолют- ных координат X0, Y0, Z0. Очевидно:
M20 |
= M21 |
× M10 |
. |
|
M30 |
= M32 × M21 × M10 |
|||
|
Столбцовые матрицы упрощаются, если оси Zi направить вдоль звеньев.
Для рис. 9.14 имеем:
|
|
|
|
|
|
|
|
lc |
= |
l1 |
+ |
|
|
l2 |
+ |
l3 |
, |
|
|
|
|
||
или |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
XC |
|
= |
|
0 |
|
× M10 + |
|
0 |
|
+ M20 × |
|
0 |
|
× М30 . |
||||||||
|
|
|
|
|
|
|
|
||||||||||||||||
|
YC |
|
|
0 |
|
|
0 |
|
|
0 |
|
||||||||||||
|
ZC |
|
|
|
l1 |
|
|
|
|
|
|
|
l2 |
|
|
|
l3 |
|
|
Решение матриц – стандартная задача для ЭВМ. С помощью ЭВМ решают как прямую, так и обратную задачи.
9.8. Динамика манипуляторов
Промышленные манипуляторы переносят грузы со значительной массой. Поэтому определение реакций в кинематических парах и нагрузок в звеньях имеет большое значение. Для динамического исследования ма- нипулятора применяют уравнение Лагранжа II-го рода, составляя одно
139
уравнение для каждой степени свободы. В результате решения систем уравнений Лагранжа находят обобщенные ускорения. Затем, используя принцип Даламбера, рассматривают равновесие звеньев и групп с нулевой степенью подвижности.
Приводим пример динамического исследования манипулятора ВПП
(рис. 9.15).
Рис. 9.15. Динамическая схема манипулятора ВПП
За обобщенные координаты примем цилиндрические координаты центра масс схвата с грузом S3 ( ϕ, R, z ). Кинетическая энергия манипуля- тора при неподвижном основании и уравновешенном звене 1:
Т = |
1 |
( J1 + J2 ) × j + m2 × S |
|
× j + m3 × R |
|
× j + m3 |
× R |
|
+ (m2 + m3 ) × z |
, |
||||||
|
2 |
|
ɺ2 |
|
|
|
ɺ2 |
|
|
ɺ2 |
|
|
ɺ2 |
|
||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
где J1 и J2 – |
моменты инерции звеньев 1 и 2 относительно оси Z и оси, |
|||||||||||||||
проходящей через центр масс S2 параллельно оси Z; |
|
|
|
|||||||||||||
m2 и m3 – |
массы звеньев 2 и 3; |
|
|
|
|
|
|
|
||||||||
S – |
расстояние от оси Z до центра масс звена 2. |
|
|
|
||||||||||||
Уравнение движения манипулятора в форме уравнений Лагранжа II рода: |
||||||||||||||||
|
|
|
|
d |
|
∂T |
|
− |
∂T |
= Q ; |
|
i = 1, 2, |
3 , |
|
|
(9.2) |
|
|
|
|
|
|
|
|
|
|
|
|
|||||
|
|
|
|
dt |
∂q |
∂q |
|
|
|
|||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||
|
|
|
|
|
i |
|
i |
|
|
|
|
|
|
|
где q1 = φ; q2 = z; q3 = R.
Обобщенные силы Qi определяем, считая, что поступательные при- воды звеньев 2 и 3 (например гидроцилиндры), расположены на подвиж- ных звеньях и создают движущие силы F2 и F3, а вращательный привод звена 1 создает движущий момент пары сил М1. Кроме того, учитываем силы тяжести звеньев G1, G2 и силы трения FT2, FT3 в парах 1-2 и 2-3. Мо-