Пример: двухзвенный манипулятор


Применение уравнений Лагранжа-Эйлера в форме (6-35) – (6-42) для описания динамики движения манипулятора рассмотрим на примере двухзвенного манипулятора с вращательными сочленениями (рис. 6.3).

Все оси сочленений рассматриваемого манипулятора параллельны оси z, перпендикулярной плоскости рисунка. Физические характеристики, такие, как положение центра масс, масса каждого звена и выбранные системы координат, указаны ниже. Требуется получить уравнения движения рассматриваемого двухзвенного манипулятора, основываясь на равенствах (6-35) – (6-42).

 

Рисунок 6.3. Двухзвенный манипулятор

Примем:

-присоединенными переменными являются ;

-первое и второе звенья имеют массы и

-параметры звеньев имеют значения ; ; .

Тогда для матрицы имеем:

 

 

, ,

 

,

 

где

 

В соответствии с определением матрицы для вращательного сочленения имеем:

.

 

Используя выражение (6-19), получаем:

 

.

 

Аналогично для и получаем:

 

 

 

 

 

Полагая, что центробежные моменты инерции равны нулю, получим формулу для матрицы псевдоинерции :

 

; .

 

Для определения слагаемых, описывающих центробежное и кориолисово ускорение, воспользуемся равенством (6-40). Для i=1 оно дает:

.

С помощью (6-41) можно получить значения коэффициентов . Подставляя их в предыдущее выражение, имеем:

 

.

 

Аналогично для i=2:

.

 

Таким образом:

.

Слагаемые, определяющие влияние гравитационных сил :

 

 

 

Таким образом, вектор, определяющий влияние силы тяжести:

 

.

 

 

Окончательно имеем уравнения описывающие динамику движения двухзвенного манипулятора:

 

,

 

 

 



Дата добавления: 2021-11-16; просмотров: 492;


Поиск по сайту:

Воспользовавшись поиском можно найти нужную информацию на сайте.

Поделитесь с друзьями:

Считаете данную информацию полезной, тогда расскажите друзьям в соц. сетях.
Poznayka.org - Познайка.Орг - 2016-2024 год. Материал предоставляется для ознакомительных и учебных целей.
Генерация страницы за: 0.009 сек.