- •Исследование кинематики манипулятора промышленного робота. Прямая задача о положениях манипулятора Практическое занятие №3
- •2.Оборудование и принадлежности.
- •3.Содержание работы.
- •3.1. Выбор систем координат
- •3.2. Понятие матрицы преобразования для кинематической пары.
- •3.2.1. Матрица одновременного перемещения и поворота детали относительно оси OiZi
- •3. 2. 3. Решение прямой задачи о положениях в общем виде
- •4. Порядок выполненпия работы.
- •5.Контрольные вопросы.
- •6.Литература
- •Оглавление
- •6. Литература 15
3.2.1. Матрица одновременного перемещения и поворота детали относительно оси OiZi
Рассмотрим неподвижную систему координат OiXiYiZi(рис.1 ). Пусть деталь или заготовка смещена вдоль оси 0iZi на отрезок cjи повернута вокруг этой оси на угол φj. Свяжем с деталью неподвижную систему координат OjXjYjZj.
Возьмем произвольную точку,
которая в системе координат
OjXjYjZjимеет координаты xj,yj,
zj. Запишем координаты этой же
точки в системе координат
OiXiYiZi:
х i =xjcosφj—yj sinφj;
y I = xj sin φj — yj cos φj;
z = zj + Cj .
Рис.1. Перемещения объекта
Эту систему можно представить в матричном виде:
или [Xi], где Mij- матрица перехода от системы OjXjYjZj к системе OjXjYjZj ,
Матрицу Mjj можно также рассматривать как некоторый оператор, преобразующий пространство «j» в пространство«j» , или оператор, осуществляющий движение поворота и переноса вдоль осиOiZi некоторой системы координат OiXiYiZi. Элементами этой матрицы в первых трех верхних строках трех левых столбцов являются косинусы углов между осями систем OjXjYjZjи OjXjYjZj . В верхних трех строках четвертого правого столбца стоят координаты начала системы Оj, в системе OjXjYjZj. В данном случае сj, есть расстояние, на которое смещено начало Оjвдоль оси OiZi. Эту матрицу в дальнейшем будем называть матрицей переноса и поворота вдоль оси OZ.
Матрица перемещения и поворота относительно осей ОХ и OY
Аналогично изложенному выше можно построить матрицы перемещений и поворотов детали относительно осей OY и ОХ.
Если система OjXjYjZj смещена вдоль оси ОiXi системы OiXiYiZiна отрезокaj и повернута вокруг этой оси на угол αj,то матрица перехода от системы OjXjYjZjк системе OiXiYiZiбудет иметь вид
Эту матрицу будем называть матрицей переноса и поворота вдоль оси ОХ.
Если система OjXjYjZjсмещена вдоль оси OiYiна отрезокbjи повернута вокруг этой оси на угол βjто матрица перехода будет иметь вид
Эту матрицу будем называть матрицей переноса и поворота вдоль оси OiYi.
Пример.
Проставить системы координат, составить таблицу кинематических пар и параметров, а также вычислить матрицы Ai, для манипулятора, кинематическая структура которого изображена на pис. 2, а.
Манипулятор имеет пять степеней свободы, которым соответствуют пять обобщенных координат: s1, θ2, s3, θ4, θ5. Специальные системы отсчета выбраны в соответствии с указаниями и показаны на конструктивной схеме (рис. 2, б). Тип кинематических пар и значения параметров сведены в табл. 2.
Рис. 2. Кинематическая структура (а) и
конструктивная схема (б) ПР
с системами координат звеньев
Таблица 2
Кинематическая пара
|
Тип пары
|
Номер звена
|
Параметры | |||
θ |
α |
s |
a | |||
0,1 1,2 2,3 3,4 4,5
|
Поступательная Вращательная Поступательная Вращательная »
|
1 2 3 4 5
|
0 θ2 0 θ4 θ5
|
0 -π/2 0 -π/2 -π/2
|
s1 s2 s3 s4 0
|
a1 a2 a3 a4 a5
|
В соответствии с этой таблицей (1) и формулой (2), определяем матрицы Ai:
Навык в составлении таблиц, подобных 1 совершенно необходим, поскольку такие таблицы исчерпывающим образом описывают кинематические схемы манипуляторов и являются входной информацией для кинематического расчетана ЭВМ.