книги / Механика промышленных роботов и манипуляторов с электроприводом
..pdfЧ= 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 ,...,л). Звенья сое диняются между собой посредством р кинематических пар, что предпола гает т уравнений связей:
? к (Я J» Я 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 Iе 1• |
Для кривошипно-ползунного механизма (рис. 4.31):
a 2l = y j l 2' ХА |
ХВ + ^ 2а 1 1 ’ 1 = û î l + û 2 1 ’ |
Vy = w-'vx, Ïïy = IГ ' й х,
где
v*= [ -^л.Ул.О ] r , vy = [ â n , à2i, XB’] T,
II |
1—1 |
*л> Ул* - < « ï 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):