Добавил:
Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:

книги / Механика промышленных роботов и манипуляторов с электроприводом

..pdf
Скачиваний:
19
Добавлен:
12.11.2023
Размер:
9.74 Mб
Скачать

Ч= u i / u i ’

где щ — передаточное отношение редуктора /-го привода. Следовательно, матрица U в этом случае является диагональной:

U = di a g [ 1/ы j , 1/ и 2 , .. 1/ и п1 ,

а движение звеньев кинематически развязано.

Достигнуть развязки движений можно и в случае размещения приводов на основании. Для этого следует ввести дополнительные механизмы кинематчиеской развязки движений, размещенные между двигателями и вход­ ными валами передаточных механизмов. Они служат для преобразования скоростей двигателей 6>= UpG>Mi где йм = [о)М1, и>м2, ...» ^мп] и должны быть подобраны с таким расчетом, чтобы матрица U^ - UU^ результирую­ щего преобразования скоростей была диагональной. Нетрудно установить, что в таком случае матрица £/р не может быть диагональной, а это означает, что механизм развязки движений может быть только дифференциальным.

В качестве примера рассмотрим тслеманипулятор “ЛЕММА”, предназ­ наченный для работы на борту космического корабля “ШАТТЛ” (рис. 4.26). Манипулятор обладает шестью степенями подвижности. Приводной блок антропоморфной руки, содержащий четыре двигателя, помещен вблизи стойки, чтобы обеспечить статическое равновесие руки в поле тяготения. Размещение двигателей у основания руки позволяет уменьшить габариты звеньев и тем самым улучшить обзор рабочей зоны, что особенно важно для телеуправляемого манипулятора. Передача движения к звеньям через шар­ ниры манипулятора производится с помощью системы коаксиальных кони­ ческих передач (рис. 4.27). Связь угловых скоростей о)3,..., w6 входных валов и скоростей <у3 , ..., q6 обобщенных координат выражается зависимо­ стью

' ? 3

-

1

0

0

0

-

“ 3

1

 

-1

1

0

0

 

? 4

 

 

 

Ш4

 

 

 

0

- 1

1

0

 

 

Я5

 

 

 

Ш5

J

 

 

0

0

- 1

1

 

ч

\

 

 

и 6

Скорость каждой обобщенной координаты является функцией скоростей двух входных валов, поэтому движения звеньев кинематически взаимосвя­ заны. Эта взаимосвязь может быть компенсирована соответствующим уп­ равлением двигателями. Закон управления определяется с помощью уравнения (4.70). Однако в данной конструкции оказалось более удобным произвести компенсацию взаимовлияния чисто механическими средства­ ми. С этой целью в приводном блоке размещен специальный дифференци­ альный зубчатый механизм, связывающий двигатели сприводными валами руки (рис. 4.28). Механизм содержит систему конических дифференциалов с тремя водилами и девятью сателлитами. Связь между скоростями колес на входе и выходе определяется зависимостью

ill

Рис. 4.27. Передача дниженмя через шарнир

' “ 3

'

2

 

0

0

 

0 '

' “ * / ‘

2

-

2

0

0

 

Ш4

 

 

°>М2

 

2

-

2

2

0

 

, “>5

 

 

” мз

 

2

-

2

2

- 1

 

ш6

 

 

°>Ы4

 

 

 

 

 

 

 

где u Mi — угловые скорости на входе.

Подставив зависимость (4.72) в (4.71) и выполнив умножение матриц, получим

Ч ъ

_

' 2

0

0

0

и М1

0

- 2

0

0

 

Ч 4

 

и М2

 

0

0

2

0

 

« 5

 

 

ШМЗ

 

0

0

0

- 1

 

Ч

 

 

» М 4

 

 

 

 

 

 

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

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

Ч

* i 1

0

 

0

«1

1

=

0

^ 2 2 ^ 2

^

0

«1

 

Ч2

0

^3 3 ^ 2 ’ « 3 >.

 

Ч3

^23 ^ 2

^

. w3 .

 

где k22(Q2^ ^23^3*» ^33^ 2»Уз* — передаточные коэффициенты рычажных систем, включая кулисные механизмы.

В том случае, когда используются шарнирные параллелограммы или другие механизмы, обладающие постоянной передаточной функцией, пе­ редаточные коэффициенты уже не зависят от конфигурации манипулято­ ра. Уравнения (4.73) позволяют найти законы управления двигателями, обеспечивающие требуемое движение обобщенных координат.

4.11. Передаточные механизмы на основе плоских четырехзвенников

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

из

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

Исследование механизмов с замкнутыми цепями производится на осно­ ве общего метода, сущность которого излагается ниже. Пусть имеется^механизм с УУ-звенной замкнутой кинематической цепью, конфигурация которой задается п обобщенными координатами q5(s = 1 ,...,л). Звенья сое­ диняются между собой посредством р кинематических пар, что предпола­ гает т уравнений связей:

? к (Я Я 2 »*• »Яп ) = 0, к = 1, 2,

,/я.

(4.74)

Система уравнений (4.74) определяет т переменных как неявные фун­ кции от оставшихся п—т переменных. Эти п—т переменных служат неза­ висимыми обобщенными координатами механизма. Свободно задавая их в области существования функций Fk, получим систему т уравнений с т неизвестными, имеющую (при выполнении необходимых условий) опреде­ ленное решение. Число и = л—т — это количество независимых обобщен­ ных координат, степень подвижности механизма. Обычное = 1, еслии > 2 — механизм дифференциальный.

Найденные из уравнений (4.74) т неизвестных могут быть названы избыточными обобщенными координатами в том смысле, что для задания конфигурации механизма достаточно только п—т независимых обобщен­ ных координат.

Как известно из математического анализа, для разрешимости уравне­ ний (4.74) относительно т и п величин необходимо, чтобы ранг матрицы W, составленной из частных производных dFk/dqs (якобиевой матрицы), был равен т. Тогда можно выбрать такой отличный от нуля якобиан J матрицы W, что из уравнения (4.74) избыточные координаты q2,—,Ят могут быть выражены через независимые обобщенные координаты.

Поясним это на примерах. Для механизма, представленного на рис. 4.29, а, при использовании в качестве обобщенных координат эйлеровых коор­ динат п = 18, т = 12. Следовательно, число независимых обобщенных координат и = 6.Это механизм с открытой кинематической цепью. Замкнем

Рис. 4.29. Четырехзпенные рычажные механизмы: а — пространственныw; 6 — плоский

цепь, введя еще одну пару 5-го класса между звеном 3и стойкой. Получим я = 1 8 , т = 17,1> = 1. Это механизм с одной степенью подвижности.

На рис. 4.29, б представлена схема плоского шарнирного четырехзвенника. Для него п = 18, т = 20, v = -2. Эта система статически неопределима. Если рассматривать идеальный плоский механизм, следует пользоваться обобщенными координатами для плоскости. В таком случае эйлеровы коор­ динаты вырождаются в две координаты начала и угол поворота связанной системы. Для вращательной пары в случае плоскости координаты начала связаны двумя уравнениями. В рассматриваемой плоской задаче п = 9, т = =8, v = 1. Таким образом, для задания положения механизма достаточно указать одну обобщенную координату.

Конфигурацию кинематической цепи плоского шарнирного четырехзвенника можно задать тремя координатами абсолютного положения {, ^ 2»<Рз- В качестве независимой обобщенной координаты можно принять любую из них, например угол Тогда <р2 и 9>з становятся избыточными обобщенными координатами.

Запишем уравнения связи

* to

II

l 3cos<p3 ,

 

х А

=

/ 2cos<p2

+

ХВ ,

 

 

SS

II

l 3sin<p3 ,

 

у А

=

l 2s\n<p2

+

Ув ,

 

 

to

1 J COS (7Г

+

<р}

+

 

 

=

/ , COSfP,

+

 

=

ХЛ,

Х0

Х0

 

 

 

|>

 

 

 

 

 

 

 

Уо

=

1 j s i п (я

+

j )

+

УА'

>'о =

Zl s i n »,l

+

Уо

Исключив из этих уравнений координаты начал связанных систем (то­ чек Л и В), получим два уравнения:

=

-/,C0S<P,

+

/ jCOS(P 2

+

/ 3cosv>3

Х0 =

0, |

F2 =

- / j S i n ^ j

+

/ 2 S i ny> 2

+

^3sin^3

Уо =

0*

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

Составим якобиеву матрицу системы (4.75):

[

ZjSimpj

- / 2s i n #>2

- / 3 sin^3

- Z J COS^J

l 2cos<p2

Z3cosV3

Если, например, отличен от нуля якобиан

- / 2

2

- / 3sin^pз

l 2 COS<P2

/ 3 C0S^P3

то координаты <р2 и Я>ъ М0ГУТ быть явно выражены через j . Случай, когда якобиан равен нулю, исключителен. Он описывается уравнением

- / 2 / 3sinv>2co s p 2 + / 2/ 3cos^>2s i n p 2 = О,

которое удовлетворяется при <р2=(Рз> т.е. если звенья 2 и 3 вытягиваются в одну линию. Такое положение механизма, характеризующееся снижением ранга матрицы Ж и приводящее к вырождению системы (4.75), называется особым.

Ту же задачу можно решить и в других обобщенных координатах, на­ пример с использованием направляющих косинусов. Нетрудно убедиться, что условие разрешимости системы уравнений связей остается прежним, т.е. <р2*<р3.

Для решения задачи о скоростях и ускорениях следует продифференци­ ровать исходную систему (4.74). При этом будут получены линейные сис­ темы относительно неизвестных параметров скоростей и ускорений, которые удобно представить в виде линейных преобразований.

Вышеописанная процедура введения уравнений связей, исключения ча­ сти уравнений и координат не обязательно должна воспроизводиться при решении частных задач. Руководствуясь особенностями механизма и ис­ пользуя лишь необходимые уравнения связей, следует сразу получить сис­ тему минимальной размерности. Трудности вычисления имеют место только при решении задачи о положениях, они связаны с существенной нелинейностью системы ^4.74). Изложенный общий метод при исследова-

ного механизма

нии частных структур приводит к удобным конечным формулам, которые могут быть использованы в инженерных задачах при исследовании кинема­ тики замкнутых стержневых механизмов, применяемых в манипуляторах, а также других вопросов. В частности, задача для плоского четырехзвенника уже была рассмотрена выше при решении обратной задачи. Приведем без вывода формулы для расчета других четырехзвенных механизмов, на­ ходящих применение в кинематике манипуляторов. Формулы даются в матричных символах, обозначение геометрических и кинематических параметров поясняется на рисунках.

Для кривошипа (рис.4.30):

= * 1а 11 + * 0 ' * л

=

- l i a n u i

=

1 1а 21 +

Уо> У л

ш

h a 2 i u \>

=

- 1 \ а \ \ ш2\

1 , а 2]е j ,

У А = - 1 \ а г У \

+ i l a l 1

Для кривошипно-ползунного механизма (рис. 4.31):

a 2l = y j l 2' ХА

ХВ + ^ 1 1 ’ 1 = û î l + û 2 1 ’

Vy = w-'vx, Ïïy = IГ ' й х,

где

v*= [ -^л.Ул.О ] r , vy = [ â n , à2i, XB’] T,

II

11

*л> Ул* - < « ï i + « 2 . ) ]

3 „ = С а 1 1 » ^ 2 1 ’ ХВ -1

 

1

0

а 2\

I F ' 1 =

0

а \ 1

h au

 

 

 

" ~ 12а \ 1

12

 

 

Для кулисного механизма (рис. 4.32):

h3 VxA + УА' v 1 О-у

у

ХА

^3«'1 1 » УА

^З а 2 1 ’ 1 - А х

+А х

II

1*

 

 

где

vх

а х

£5|

к о

1—1

Е*л

2А3а 11(

5

« п

> «21-1

% =

 

 

Уа

2Л3а21>

- < « ï i

Рис. 4.32. Расчетная схема кулисного механизма

Рис. 4.33. Расчетная схема кулисного

 

механизма с ведущим ползуном

 

 

 

Рис. 4.34. Расчетная схема тангенсно-

 

 

 

го механизма

W 1 = 4-

- V n

' f l 3a 2 l

 

21

а \ l a 2 1

- V u

 

‘ 1 1а 21

 

■ V 2 1

Для кулисного механизма с ведущим ползуном (камнем) (рис. 4.33) :

а \ 1 = CAS

х о

-if)/(2x0li), âjj = Л3 Л3 /(х0 /[),ап = -3 2 3 Л3 )/ (XQ/J),

'2 1

</ 1« I 1

* 3 * 2 1

2*3*21>/*3‘

Для тангенсного механизма (рис. 4.34):

 

*1

=

- V

a 21>

 

 

 

% = W-l v x , ау = I T ' S , ,

 

 

где

 

 

 

 

 

 

 

VJt

 

t **1^ 11’

■*1<*21^»

‘’у

Е*1»

а дг

=

 

 

 

2A'i<ijj,

-AJ ÛJ

2A| â2 ]]>

л ^

 

j ,

 

»

 

 

 

r

i = _ L f

0

i l .

 

 

 

 

а 2\

L

~a 2l a \ J

 

 

4.12. Кинематика механизма универсального шарнира

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

Замкнем кинематическую цепь, соединив тело 3 со стойкой вращатель­ ной парой (рис. 4.35, б). Получим разновидность сферического механизма, известного как шарнир Гука, или универсальный шарнир. Шарнир Гука относится к карданным механизмам, обеспечивающим вращение двух сое­ диняемых им валов при переменном угле между ними. Это простейший карданный механизм. Рассмотрим кинематику с помощью операторно-мат­ ричного аппарата.

Рис. 4.35. Четырехзвенные сферические механизмы: а — с открытой кинематической цепью; б — с замкнутой цепью

На рис. 4.36 представлена схема шарнира Гука с введенными системами координат звеньев. Шарнир образован вилкой 7, крестовиной 2, вилкой 3. Обе вилки с помощью вращательных пар установлены на стойке, пары Л и В выполнены сдвоенными. Оси вращения вилок пересекаются в точке под углом а. Неподвижная система, связанная со стойкой, введена таким обра­ зом, что оси х и у лежат в плоскости осей вилок. Расположение осей, связанных с подвижными звеньями, видно из рисунка.

Переход к осям xyz(1) осуществляется дс-поворотом осей xyz на угол 0j, переход к осям xyz(2) — z-поворотом осей x y z на угол (р2, а переход к осям jtyz(3) — y-поворотом осей x y z на угол 03:

xyz

v

f l ) z (ip2 \

( 2 )

y < e 3 )

xyz

(3 )

xy z

* xyz

 

»

 

На основании описанных переходов матрицы ориентации связанных сис­ тем определяются выражениями

т j = X, т 2 = XZ, т з = XZY

Введем вспомогательную неподвижную систему xyz{5\ полученную z- поворотом системы xyz на угол а.Тогда система хyz(3) может быть получена ^-поворотом системы xyz(s) на угол 03:

T3 =ZSX 3.

Углы 0 j и ф$ определяют положение связанных систем координат вход­ ного и выходного звеньев относительно стойки. Связь между ними, а также между их производными необходимо установить. Для этого воспользуемся очевидным условием, состоящим в ортогональности осей z ^ и у(3):

T zl

т у3 = 0,

'

(4.76)

гдет21 и т у3 — вектор-столбцы матриц Tj и т 3, выражающие орты осей z(1) и у (3):

Соседние файлы в папке книги