logo search
Лекция Робототехника (КРАСНОБАЕВ)

Алгоритм формирования систем координат звеньев

Для каждого звена манипулятора с n степенями свободы этот алгоритм формирует ортонормированную систему координат. Системы координат нумеруются в порядке возрастания от основания к схвату манипулятора. Взаимное расположение соседних звеньев описывается однородной матрицей преобразования размерностью 4х4.

Параметры систем координат звеньев манипулятора Пума

Сочленение i

Пределы измерения

1

90

-90

0

0

-160-+160

2

0

0

431,8 мм

149,09 мм

-225-45

3

90

90

-20,32 мм

0

-45-225

4

0

-90

0

433,07 мм

-110-170

5

0

90

0

0

-100-100

6

0

0

0

56,25 мм

-266-266

Рисунок 5.4. Формирование систем координат звеньев