
- •1. Введение
- •1. Цель работы
- •2. Методы решения прямой задачи кинематики
- •3. Обзор кинематических параметров описания углового и пространственного движения манипулятора
- •3.1. Параметры Эйлера, Крылова, направляющие косинусы. Матрицы преобразования 44
- •3.2. Параметры Родрига – Гамильтона, Кейли – Клейна, кватернионы и их дуальные аналоги
- •3. Обзор методов решения обратной задачи кинематики
- •3.1. Аналитические методы
- •3.2. Численные методы
- •5. Приложение 1. Пример использования различных кинематических параметров
- •5.1. Матрицы направляющих косинусов
- •5.2. Кватернионы (кватернионные матрицы)
- •5.3. Параметры Кейли-Клейна
- •6. Приложение 2. Пример решение прямой и обратной задачи для манипулятора типа puma
- •7. Контрольные вопросы
- •8. Задания для выполнения лабораторно-исследовательской работы Задание 1
- •Задание 2
- •Задание 3
- •9. Содержание отчета о работе
- •Литература
5.3. Параметры Кейли-Клейна
Параметры Кейли-Клейна представляют собой комплексно-сопряженные комбинации параметров Родрига-Гамильтона, составляющих кватерниона, и имеют вид
|
(55) |
Матрица перехода между соседними звеньями (66) составлена из элементов (65)
|
(56) |
Таким образом, в результате последовательного перемещения от одного звена к другому будут получены матрицы перехода вида (56), которые будучи перемноженными между собой в том же порядке дадут результирующую матрицу, связывающую основание манипулятора с последним звеном.
При
совмещении систем координат выше были
получены кватернионы, соответствующие
элементарным плоским поворотам. Их и
будем использовать для составления
матриц перехода. Переход
можно описать двумя кватернионами:
;
2)
.
В результате чего можно составить две матрицы перехода
|
|
|
(57) |
Переход
описан через кватернион вращения
,
откуда
|
(58) |
Так как при переходе от системы координат к кватернион аналогичен кватерниону , то получим
|
(59) |
В результате перемножения полученных матриц перехода (56) - (59), результирующая матрица будет иметь вид:
|
|
и в окончательном виде, получим:
|
(60) |
6. Приложение 2. Пример решение прямой и обратной задачи для манипулятора типа puma
Для рассматриваемого манипулятора были получены уравнения решения прямой и обратной задач кинематики, приведенные ниже. Переход от базовой системы координат к системе координат, связанной с захватом, осуществлялся в соответствии с представлением Денавита – Хартенберга. Повороты и перемещения, описывающие движение каждого звена указаны в таблице 1, в соответствии с ними построена матрица преобразования T (61).
Таблица 1
Параметры систем координат звеньев манипулятора |
|||||
i |
|
|
|
|
|
1 |
|
90 |
0 |
0 |
|
2 |
|
0 |
|
0 |
|
3 |
|
0 |
|
0 |
|
Рис. 9. Общий вид типового трехзвенного манипулятора |
Рис. 10. Кинематическая схема трехзвенного манипулятора |
|
(61) |
Прямые и обратные уравнения кинематики приведены в уравнениях (62) и (63) соответственно.
|
(62) |
|
(63) |
Знак
в выражении для
обозначает общую конфигурацию руки
робота. Положительное значение
соответствует решению, при котором
локоть направлен книзу, отрицательное
– когда локоть направлен кверху.
В
Рис.
11. Неопределенность,
возникающая
при решении
обратной задачи кинематики