Цель работы: Провести расчёт положения схвата для заданной кинематической схемы манипулятора тензорно-матричным методом.
Теоретические сведения
Прямая задача кинематики о положениях состоит в определении абсолютных положений звеньев при их заданных относительных положениях.
Тензорно-матричный метод
Для определения величины результирующего радиус-вектора крайней точки многозвенного механизма, необходимо, составить соответствующее матричное уравнение, характеризующее положение крайней точки, относительно базовой системы координат.
Для тензорно-матричного метода нет необходимости изменения систем координат звеньев. Достаточно записать соответствующие матрицы поворота и переноса для базовой системы координат совмещенной с системами координат соответствующих звеньев. При решении прямой задачи о положении схвата манипулятора обычно используют метод преобразования координат.
Рассмотрим трехмерную декартовую систему координат, являющуюся правосторонней. Примем соглашение, в соответствии с которым будем считать положительными такие повороты, при которых (если смотреть с конца полуоси в направлении начала координат) поворот на 90° против часовой стрелки будет переводить одну полуось в другую. На основе этого соглашения строится следующая таблица, которую можно использовать как для правых, так и для левых систем координат:
Если ось вращения
Положительным будет
направление поворота
X
От y к z
Y
От z к x
Z
От x к y
Матрицы поворота М определяют поворот системы координат соответствующего звена для корреляции относительно предыдущего по порядку. В зависимости от поворота вокруг соответствующей оси выделяется три стандартных типа матриц поворота. Повороты вокруг осей Х, Y и Z определяются соответственно матрицами:
, (1)
, (2)
. (3)
Подставляя значения углов поворота относительно соответствующих осей, определяем матрицы поворота.
В сочетании с матрицами поворота, учитываются так называемые матрицы переноса L, по факту являющиеся векторами. Они определяют линейные смещения систем координат звеньев друг относительно друга. В общем виде, матрица L имеет следующий вид:
. (4)
Положение схвата манипулятора, описываемое радиусом вектором
, (5)
определяется векторным уравнением, сочетающим комбинацию длин векторов переноса с перемещениями звеньев и матриц переноса . Построение уравнения начинается с крайнего звена и по порядку, вплоть до начального.
Каждое следующее добавление нового элемента в выражение по определению положения схвата сопровождается, либо добавлением нового слагаемого в виде линейного перемещения звена, либо матрицы поворота, при угловом перемещении (2, 5).
(6)
Порядок выполнения работы
1. Выбрать схему манипулятора и таблицу с расчётными данными в соответствии с вашим вариантом.
2. Определить вид движения каждого звена (по таблице).
3. Для каждого звена манипулятора записать матрицы поворота в соответствии с формулами (1-3) и матрицы переноса по формуле (4).
4. Составить векторное уравнение для определения положения схвата манипулятора, используя формулы (5,6).
5. Подставив в выражение (14) общие численные значения для обобщенных переменных и геометрических параметров кинематической схемы, определить в координатах положение схвата манипулятора для общего расчета.
6. Оформить отчёт в виде текстового документа в формате *.doc или *.docx.
Пример выполнения лабораторной работы
Рассмотрим пример расчета положения схвата для кинематической схемы манипулятора, представленной на рис. 1, тензорно-матричным методом, с учетом представленных в таблице 1 исходных данных для расчета.
Выражение для радиус-вектора точки выходного звена в соответствии с правилами построения принимает следующий вид:
. (7)
На рисунке 2 проиллюстрировано построение систем координат звеньев в соответствии с тензорно-матричным методом. Для всех кинематических пар, ориентация звеньев остается постоянной, с тем отличием, что происходит корректирование угла поворота в случае вращательного движения ( и ) и дополнительный перенос в случае поступательного движения . При условии, что , система координат совпадает с , а с .
Рисунок 2 - Системы координат и параметры трехзвенного манипулятора для тензорно-матричного метода расчета задачи о положениях
Звено 1 вращается относительно стойки и базовой системы координат вокруг оси Z. Соответственно в уравнении (7) учитывается длина звена 1 вдоль оси Z:
(8)
и матрица поворота вокруг оси Z:
. (9)
является общей для всех последующих звеньев механизма после первого. Второе звено – поступательное, поэтому вместо матрицы поворота, учитывающей обобщенные угловые координат, используется матрица переноса с обобщенной линейной координатой, выраженной перемещением второго звена относительно первого вдоль оси X в отрицательном направлении:
. (10)
Длина звена 2 учитывается вектором:
. (11)
Третье звено является последним в кинематической схеме и определяется матрицей поворота вокруг оси X:
(12)
и длиной двусоставного звена
. (13)
Знак “–“ указывает на отрицательное направление звеньев относительно осей.
Подставляя значения матриц (7-12) в (6), определим значение радиус-вектора схвата в общем виде:
. (14)
Подставим в выражение (14) общие численные значения для обобщенных переменных и геометрических параметров кинематической схемы из таблицы 1, определив в координатах, положение схвата манипулятора для общего расчета:
(м). (15)
Варианты заданий
№ варианта
задание
№ варианта
задание
1
2.1
21
8.3
2
2.2
22
9.1
3
2.3
23
9.2
4
3.1
24
9.3
5
3.2
25
10.1
6
3.3
26
10.2
7
4.1
27
10.3
8
4.2
28
11.1
9
4.3
29
11.2
10
5.1
30
11.3
11
5.2
31
12.1
12
5.3
32
12.2
13
6.1
33
12.3
14
6.2
34
13.1
15
6.3
35
13.2
16
7.1
36
13.3
17
7.2
37
14.1
18
7.3
38
14.2
19
8.1
39
14.3
20
8.2
40
1.3
Пример варианта задания: 16 - 5.1. Вариант 16, схема 5, подвариант 1.
Схема 1
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
360
180
0,2
0,2
2
1,5
1,25
1,0
0,2
0,2
3
0,75
0,25
360
180
0,2
0,2
2
1
1,75
360
270
0,1
0,2
2
1,75
1,4
0,5
0,1
0,2
3
1,0
0,3
270
0
0,1
0,1
3
1
2
360
270
0,1
0,1
2
1,75
1,3
0,5
0,2
0,2
3
1,2
0,5
360
180
0,1
0,1
Схема 2
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
360
180
0,2
0,2
2
1,5
220
180
0,2
0,2
3
0,75
0,25
1,0
0,5
0,2
0,2
2
1
1,75
360
270
0,1
0,2
2
1,75
270
0
0,1
0,1
3
1,0
0,3
1,0
0,5
0,1
0,2
3
1
2
360
270
0,1
0,1
2
1,75
210
180
0,1
0,1
3
1,2
0,5
1,0
0,5
0,2
0,2
Схема 3
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
1,0
0,5
0,2
0,2
2
0,5
360
180
0,2
0,2
3
1,5
1,0
0,5
0,2
0,2
4
0,75
0,25
360
0
0,2
0,2
2
1
1,75
1,25
0,75
0,1
0,2
2
0,75
360
0
0,1
0,1
3
1,75
1,25
0,75
0,1
0,2
4
1,0
0,3
360
180
0,1
0,2
3
1
2
1,6
1,0
0,1
0,1
2
0,75
360
180
0,1
0,1
3
1,75
1,25
1,0
0,2
0,2
4
1,2
0,5
360
90
0,1
0,1
Схема 4
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
360
180
0,2
0,2
2
0,5
1,0
0,5
0,2
0,2
3
1,5
1,0
0,5
0,2
0,2
4
0,75
0,25
360
0
0,2
0,2
2
1
1,75
360
0
0,1
0,1
2
0,75
1,25
0,75
0,1
0,2
3
1,75
1,25
0,75
0,1
0,2
4
1,0
0,3
360
90
0,1
0,2
3
1
2
360
90
0,1
0,1
2
0,75
1,6
1,0
0,1
0,1
3
1,75
1,25
1,0
0,2
0,2
4
1,2
0,5
360
270
0,1
0,1
Схема 5
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
360
180
0,1
0,2
2
0,5
180
0
0,2
0,2
3
1,5
360
180
0,2
0,2
4
0,75
0,25
1,0
0,5
0,2
0,2
2
1
1,75
360
0
0,1
0,2
2
0,75
200
90
0,1
0,1
3
1,75
360
90
0,1
0,2
4
1,0
0,3
1,0
0,5
0,1
0,2
3
1
2
360
90
0,1
0,1
2
0,75
270
180
0,1
0,1
3
1,75
360
0
0,2
0,2
4
1,2
0,5
1,0
0,5
0,1
0,1
Схема 6
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
2,0
0,5
0,2
0,2
2
0,5
360
180
0,2
0,2
3
1,5
1,0
0,5
0,2
0,2
4
0,75
0,25
360
0
0,2
0,2
2
1
1,75
2,25
0,75
0,1
0,2
2
0,75
360
0
0,1
0,1
3
1,75
1,25
0,75
0,1
0,2
4
1,0
0,3
360
90
0,1
0,2
3
1
2
1,6
1,0
0,1
0,1
2
0,75
360
90
0,1
0,1
3
1,75
1,25
1,0
0,2
0,2
4
1,2
0,5
360
270
0,1
0,1
Схема 7
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
2,0
0,5
0,2
0,2
2
0,5
360
180
0,2
0,2
3
1,5
270
0
0,2
0,2
4
0,75
0,25
1,0
0,5
0,2
0,2
2
1
1,75
2,25
0,75
0,1
0,2
2
0,75
360
0
0,1
0,1
3
1,75
210
180
0,1
0,2
4
1,0
0,3
1,25
0,75
0,1
0,2
3
1
2
1,6
1,0
0,1
0,1
2
0,75
360
90
0,1
0,1
3
1,75
300
0
0,1
0,1
4
1,2
0,5
1,25
1,0
0,2
0,2
Схема 8
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
0,5
2,0
0,5
0,2
0,2
2
1,0
0,5
360
180
0,2
0,2
3
1,0
270
0
0,2
0,2
4
0,75
0,25
1,0
0,5
0,2
0,2
2
1
0,75
2,25
0,75
0,1
0,2
2
1,25
0,75
360
0
0,1
0,1
3
1,25
270
90
0,1
0,2
4
1,0
0,3
1,25
0,75
0,1
0,2
3
1
1,0
1,6
1,0
0,1
0,1
2
1,35
1,0
360
90
0,1
0,1
3
1,5
270
90
0,1
0,1
4
1,2
0,5
1,25
1,0
0,2
0,2
Схема 9
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
2,0
0,5
0,2
0,2
2
0,5
1,25
1
0,2
0,2
3
1,0
0,5
270
0
0,2
0,2
4
0,75
0,25
1,0
0,5
0,2
0,2
2
1
1,75
2,25
0,75
0,1
0,2
2
1,0
1,5
0,75
0,1
0,1
3
1,25
0,75
270
90
0,1
0,2
4
1,0
0,3
1,25
0,75
0,1
0,2
3
1
1,0
1,6
1,0
0,1
0,1
2
0,75
0,8
0,5
0,1
0,1
3
1,5
1,0
270
90
0,1
0,1
4
1,2
0,5
1,25
1,0
0,2
0,2
Схема 10
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1500
360
90
0.1
0.2
2
700
200
170
60
0.1
0.3
3
100
350
100
0.1
0.4
4
300
200
360
180
0.2
0.4
2
1
1000
360
180
0.1
0.2
2
500
150
200
90
-1
-0.3
3
100
300
90
0.1
0.4
0.1
0,3
4
300
200
360
90
0.2
0.4
3
1
200
360
270
0.1
0.2
2
1000
300
270
180
0.1
0.3
3
200
500
200
0,1
0,4
4
400
200
360
270
0.2
0.4
Схема 11
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
2,0
0,5
0,2
0,2
2
0,5
1,0
0,5
0,2
0,2
3
1,5
360
180
0,2
0,2
4
0,75
0,25
360
0
0,2
0,2
2
1
1,75
2,25
0,75
0,1
0,1
2
0,75
1,25
0,75
0,1
0,2
3
1,75
360
0
0,1
0,2
4
1,0
0,3
360
90
0,1
0,2
3
1
2
3,25
1,0
0,1
0,1
2
0,75
1,5
1,0
0,1
0,1
3
1,75
360
90
0,2
0,2
4
1,2
0,5
360
270
0,1
0,1
Схема 12
№
Варианта
Звено
Длина, м
Угол поворота, град
Перемещение, мм
Общ
Расч
Общ
Расч
1
1
1,5
2,0
0,5
0,2
0,2
2
0,5
1,0
0,5
0,2
0,2
3
1,5
360
180
0,2
0,2
4
0,75
270
0
0,2
0,2
2
Последнее изменение этой страницы: 2018-05-10; просмотров: 494.
stydopedya.ru не претендует на авторское право материалов, которые вылажены, но предоставляет бесплатный доступ к ним. В случае нарушения авторского права или персональных данных напишите сюда...