27. Как определяется скорость точки звена манипулятора?

Для того, чтобы воспользоваться уравнениями Лагранжа-Эйлера, необходимо знать кинетическую энергию рассматриваемой физической системы, а следовательно, и скорости всех её точек.

Рассмотрим произвольную точку, неподвижную относительно 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а)

а для поступательного сочленения:

.

Используя эту матрицу, можно написать:

.

28. Как записывается кинетическая и потенциальная энергия манипулятора?

Зная скорость произвольной точки каждого звена манипулятора, найдём кинетическую энергию i-го звена.

Обозначим через кинетическую энергию i-го звена (i=1, 2, …, n). Пусть кинетическую энергию элемента массы dm i-го звена. Тогда:

. (10-1)

Здесь вместо скалярного произведения используется оператор (след матрицы ), что в дальнейшем позволит перейти к матрице инерции i-го звена.

Подставляя в выражение (10-1) значение из равенства (9-20), получим выражение для кинетической энергии элемента массой dm:

(10-2)

Матрица характеризует положение точки i-го звена относительно базовой системы координат, обусловленное изменением координаты .

Данная матрица одинакова для всех точек i-го звена и не зависит от распределения массы в этом звене, также как и . Таким образом:

. (10-3)

Интегральный член в скобках представляет собой матрицу инерции i-го звена:

. (10-4)

Преобразуя выражения, получим:

, (10-5)

где однородные координаты центра масс i-го звена в i-й системе координат;

- тензор инерции, где i, j, k принимают значения x_i, y_i, z_i (оси i-ой системы координат), а - символ Кроникера.

Формулу (6-26) можно также записать в виде:

. (10-6)

Здесь и j, k=1, 2, 3, а - радиус вектор центра масс i-го звена в системе координат i-го звена. Таким образом, полная кинетическая энергия манипулятора равна:

. (10-7)

Отметим, что величина J_i (i=1, 2,…, n) зависит только от распределения массы i-го звена в i-й системе координат и не зависит ни от положения, ни от скорости звеньев. Это позволяет однажды вычислив матрицу J_i, использовать полученное значение в дальнейшем для вычисления кинетической энергии манипулятора.

Потенциальная энергия манипулятора

Обозначим полную потенциальную энергию манипулятора через Р, а потенциальную энергию i-го звена – через . Тогда:

. (10-8)

Суммируя потенциальные энергии всех звеньев, получаем:

. (10-9)

Здесь - вектор-строка, описывающая гравитационное ускорение в базовой системе координат. В земной системе координат , а g – ускорение свободного падения на поверхности Земли (g=9,8062 м/с²).