Добавил:
Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:
книги / Теория механизмов и механика машин.-1.pdf
Скачиваний:
5
Добавлен:
20.11.2023
Размер:
47.33 Mб
Скачать

В нашем случае R = /3 и 5 = 27г/2(1 - cos</?т ), следовательно,

д _ Ф_ _

S/lj _

1 - COS ifim

47г

47г

2

На рис. 17.10, а при г = AD1соырт « 0,24 коэффициент сервиса в = 0,38. График зависимости в = в(г) для манипу­ лятора с размерами звеньев, изображенными на рис. 17.10, а, представлен на рис. 17.10, б). Подобные графики нужны не только при исследовании имеющегося манипулятора, но и при проектировании кинематических схем манипуляторов по за­ данным условиям.

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

17.3. Задачи о положениях манипуляторов

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

Для исследования движения исполнительного механизма манипулятора в пространстве наибольшее распространение получил метод преобразования координат с матричной фор­ мой записи. Он позволяет упорядочить выполняемые действия и сократить математические выкладки. При этом методе вы­ бирают число систем координат, равное числу элементов зве­ ньев, образующих кинематические пары. Неподвижная систе­ ма координат z(°), 2/(°), z(°) обычно связывается со стойкой, а с каждой кинематической парой связывается подвижная сис­ тема координат, одна из осей которой связана с характерны­ ми признаками звена, например осевой линией. Для примера на рис. 17.2, а показаны координатные оси О ^ М 1), 0 (2)®(2),

0 (з)*(з),о(4М 4) (ИЛИ о(°Ы °)) четырехзвенной открытой ки­ нематической цепи из звеньев 1, 2, 3, 4, моделирующей струк­

туру руки человека (см. рис. 17.2, б).

Ось z направляют

вдоль оси кинематической пары, а ось

дополняет правую

систему координат

 

Применение метода преобразования координат для реше­ ния прямой задачи о положениях проиллюстрируем на приме­ ре кинематической схемы промышленного робота (рис. 17.11). Четыре подвижных звена 1, 2, 3 и 4 образуют четыре однопо­ движные пары, из которых три вращательные и одна поступа­ тельная. Число степеней подвижности робота равно четырем:

W = 6п 5pi = 6 - 4 —5*4 = 4.

Поэтому для решения прямой задачи о положениях долж­ ны быть заданы четыре обобщенные координаты: относитель­

ные углы поворота звеньев

= <7i(*), ^21 = <72(0> ¥>43 = <7 4

(0

и относительное перемещение вдоль оси звена 3 S32 = <7 3

(0

(см. рис. 17.11).

 

 

 

 

 

Требуется

определить

радиус-вектор р^)

точки

Е

схвата относительно неподвижной

системы

координат

О(°)х(0)2/(°)г(0),

связанной со стойкой

5 (или О).

Оси систем

координат ориентированы относительно элементов кинемати­ ческих пар следующим образом:

ось z(°) неподвижной системы координат стойки направ­ лена вдоль оси вращательной пары А\

со звеном 1 связана система 0 (l)*(l)y(l)z(l) , имеющая сме-

щение /ю начала координат О(2) вдоль оси

Ось z^1) со­

впадает с осью z(°), а ось

направлена по оси вращательной

кинематической пары В ;

 

 

со звеном 2 связана система 0 (2)ж(2)у(2М 2), имеющая на­ чало координат 0 (2), совпадающее с точкой 0 (1). Ось у(2) со­ впадает с осью у(1), т.е. с осью вращательной кинематической пары В ;

начало координат системы 0(3)а;(3)у(3)г (3) имеет смеще­ ние /32 относительно точки 0 (2) вдоль оси z(2). Ось z(3) вы­ брана совпадающей с осью z(2);

координата z(4) точки Е схвата 4 задана в системе 0 (4)x(4)y(4)z(4), ось ?/(4) которой направлена по оси вращатель­ ной кинематической пары D.

Для определения радиуса-вектора р^) необходимо раз­ решить матричное уравнение перехода к системе координат

О (°Ы 0)у(0)г(°):

 

Р{Е = Т*0Р{Е = Г4зТз2721Т10/44)

(17Л)

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

Координаты точки Е в трехмерном пространстве записы­ ваются в виде матриц

д(4) —

|Ч4Ч

= ( , °

ИЛИ

-p(g0)' =

х<\е

Ре

~

yf

)

 

U°v

 

 

U4)J

\IE D J

 

Здесь

— матрица перехода от системы

к

системе

 

 

(элементарная матрица поворота во­

круг оси z) и перемещения вдоль оси z:

 

 

 

COSV?10

- sin v?io

0

0

 

7i(z) _ sin <pw

cos <pw

0

0

 

i l0

0

0

1 k o

 

 

V

о

0

0

1

— матрица перехода от системы

 

к системе

 

 

(элементарная матрица поворота относительно

оси у):

гр(у) —

COS V?21

0

Sin <£>21

°\

0

1

0

0

i 21 -

- sin <£>21

0

COS <^21

0

 

0

0

0

1 /

Т^2 — матрица перехода от системы О ^ М 3)^ 3)^ 3) к сцстеме 0 (2)a:(2)y(2)z(2) (элементарная матрица перемещения ^доль оси г):

 

/ 0

 

0

0

0

\

r (x) _

I

0

0

0

5зг .

32

0

0

0

0

/

 

\ 0

0

0

1

— матрица перехода от системы O ^ x ^ y ^ z ^ к системе

0 (3)z(3)y(3).z(3) (элементарная матрица поворота вокруг о^и у)'

cos <£>43

0

Sin <£>43

°\

0

1

0

0

- sin <£>43

0

cos ЩЗ

0

0

0

0

1 /

Подставив эти матрицы в формулу (17.1), получим коор­

динаты точки Е в системе O(0)z(0)2/(0)z(0). Развернутые фор­ мулы, определяющие положение точки Е схвата ввиду гро­ моздкости не приведены. При решении конкретных задач на ЭВМ целесообразно воспользоваться библиотекой стандарт­ ных подпрограмм для выполнения элементарных операций с матрицами.

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

вектор р^\ например точки Е , есть векторная функция обоб­ щенных координат:

=P E (Q1’ Q2I 93> •••>9п)>

поэтому скорость точки Е определяется по соотношению

г>£ =

dtе

Е

(17.2)

или

 

 

1=1

 

 

 

( 0)

 

 

 

.(0)

 

 

 

dtс p

 

VEx = ХЕ

dt

 

 

 

 

 

 

 

.(0)

dV(E .

 

v E y

=

Уе

dt

(17.3)

 

 

.(0) _

(o )

 

*>Ez

=

d z E

 

ZE

dt

 

 

 

 

 

v E - \ /4 x + vEy + 4,-

Абсолютную угловую скорость j -то звена относительно стойки находят сложением угловых скоростей при относитель­ ном движении звеньев:

<17'4)

1=1

индекс г/(г — 1 ) указывает на порядковые номера звеньев, участвующих в относительном движении, например:

6J40 = £7ю + ^21 + ^32 + ^43*