- •Лекция 6 Уравнения кинематики манипулятора
- •Классификация манипуляторов
- •Обратная задача кинематики
- •Метод обратных преобразований
- •Лекция 7 Геометрический подход
- •Определение различных конфигураций манипулятора
- •Решение обратной задачи кинематики для первых трех сочленений
- •Решение для первого сочленения
- •Решение для второго сочленения
- •Лекция 8 Решение для третьего сочленения
- •Решение обратной задачи кинематики для последних трех сочленений
- •Решение для четвертого сочленения
- •Решение для пятого сочленения
- •Решение для шестого сочленения
- •Лекция 9 Уравнения вида конфигурации для определения индикаторов конфигурации манипулятора
- •Машинное моделирование
- •Динамика манипулятора
- •Метод Лагранжа-Эйлера
- •Скорость произвольной точки звена манипулятора
- •Лекция 10 Кинематическая энергия манипулятора
- •Потенциальная энергия манипулятора
- •Уравнение движения манипулятора
- •Уравнения движения манипулятора с вращательными сочленениями
- •Пример: двухзвенный манипулятор
Скорость произвольной точки звена манипулятора
Для того, чтобы воспользоваться уравнениями Лагранжа-Эйлера, необходимо знать кинетическую энергию рассматриваемой физической системы, а следовательно, и скорости всех её точек.
Рассмотрим произвольную точку, неподвижную относительно i-го звена и заданную в системе координат i-го звена однородными координатами (рис. 9.2):
. (9-10)
Обозначим через координаты этой же точки относительно базовой системы координат. Матрицаобозначает матрицу преобразования однородных координат, определяющую пространственное положение системы координатi-го звена относительно системы координат (i-1)-го звена, а -матрицу, определяющую связь между системой координатi-го звена и базовой системой координат.
Рисунок 9.2. Точка i-го звена
Тогда связь между иопределяется соотношением:
, (9-11)
где . (9-12)
Если i-е сочленение – вращательное, то матрица имеет вид:
, (9-13)
Если i-ое сочленение – поступательное, то матрица имеет вид:
. (9-14)
В общем все ненулевые элементы матрицы являются функциями величини, причём в зависимости от типаj-го сочленения илипредставляет собой присоединенную переменную этого сочленения, а остальные величины – известны (задаются конструкцией манипулятора). В выводах уравнений движения, как вращательных, так и поступательных, используется обобщённые координаты,, еслиi-е сочленение – вращательное и , еслиi-е сочленение – поступательное).
Скорость точки относительно базовой системы координат (при):
. (9-15)
Частные произведение матрицы по переменнымлегко вычисляется с помощью матрицы, которая для вращательного сочленения имеет вид:
, (9-16а)
а для поступательного сочленения:
. (9-16б)
Используя эту матрицу, можно написать:
. (9-17)
Например, для манипулятора с вращательными сочленениями . Используя равенство (9-13), имеем:
Таким образом, для
(9-18)
По смыслу равенство (9-18) описывает изменение положения точек i-го звена, вызванное движением в j-м сочленении манипулятора. Для упрощения формул введём обозначение , с учетом которого равенство (9-18) можно представить для:
(9-19)
Используя введённое обозначение, формулу для можно записать в форме:
. (9-20)
Определяем величину, характеризующую эффект взаимодействия сочленений:
(9-21)
Например, для манипулятора вращательными сочленениями при иимеем:
.