- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 1. Кинематика им мр
- •Координаты и параметры им
- •Описание им мр
- •Системы координат
- •Координаты шарниров
- •Параметры им
- •Обобщенные координаты им
- •Матрицы преобразований поворота
- •1.6.1. Матрицы поворота вокруг одной координатной оси (матрицы элементарных поворотов).
- •1.6.2. Матрицы композиции элементарных поворотов
- •Этот факт иллюстрирует рисунок 1.10. Зеленый цвет – последовательность поворотов ск. Синий – последовательность преобразований векторов, заданных координатами в подвижной ск, в неподвижную.
- •1.6.3. Матрицы сложных поворотов
- •1.6.4. Матрицы поворота ск смежных звеньев им
- •Очевидно,
- •1.6.5. Матрица преобразования поворота ск произвольных звеньев
- •Положение им в рабочем пространстве. Линейные и угловые координаты звеньев
- •2.1. Линейные координаты звеньев им относительно базовой ск
- •Прямая позиционная кинематическая задача
- •Понятие обратной позиционной кинематической задачи
- •2.4.1 Сингулярности окз
- •2.4.2 Обратная кинематическая задача в управлении манипулятором
- •Однородные координаты и однородные преобразования в робототехнике
- •2.6 Блочные матрицы
- •2.7 Специальные системы координат
- •Угловая и линейная скорости звеньев им
- •3.1. Угловые скорости звеньев им
- •Введем обозначения
- •3.2. Свойства векторов сj(0) .
- •3.3. Матрицы-якобианы угловых скоростей им.
- •3.4. Производные по времени матриц преобразований поворота.
- •3.4.1. Запись производной по времени матрицы I-1i
- •3.4.2. Свойства матрицы векторного произведения (.)
- •3.4.3. Вычисление `I-1i .
- •3.4.4. Производная по времени матрицы 0i.
- •3.5. Линейные скорости звеньев им
- •(Различные индексы суммирования во втором и третьем слагаемых приняты для удобства дальнейших преобразований).
- •Развернем полученное выражение, подставив в него
- •Получим: I I
- •3.6. Свойства векторов Dij(0)
- •3.7. Матрицы-якобианы линейных скоростей им.
- •3.8. Матрица-якобиан последнего звена им.
- •3.9. Прямая кинематическая задача о скорости им
- •3.10. Понятие обратной задачи о скорости им
- •3.11. Примеры решения прямой и обратной задач о сокорости звеньев им
- •3.11.1. Прямая и обратная кинематические задачи об угловой скорости звеньев им
- •3.11.1. Прямая и обратная кинематические задачи о линейной скорости звеньев им
- •Угловые и линейные ускорения звеньев
- •4.1. Угловые ускорения
- •4.2. Линейные ускорения
- •Раздел 2. Динамика им мр
- •Силы и моменты.
- •Силы, действующие на звенья им
- •Моменты, действующие на звенья им.
- •Сумма двух последних слагаемых дает
- •С учетом этого выражение для I (0) примет вид:
- •Выражение для Mиj(0) имеет вид:
- •Силы, действующие вдоль осей шарниров им.
- •1.4. Моменты, действующие вдоль осей шарниров.
- •1.5. Силы и моменты, развиваемые приводами манипулятора. Обратная задача динамики им.
- •1.6. Уравнения статического равновесия им.
- •Симметрия уравнений озд и уравнений для определения скоростей звеньев им.
- •Управление по вектору силы
- •Уравнения движения им мр
- •Вывод уравнений движения
- •С учетом выполненных преобразований и введенных обозначений первое выражение п.2.1 примет вид:
- •2.4. Запись уравнений движения им с использованием матриц преобразования между ск звеньев.
- •2.3. Пример расчета матрицы инерционных коэффициентов.
Раздел 2. Динамика им мр
Силы и моменты.
Рассматриваются силы и моменты, действующие на звенья и шарниры ИМ, а также силы и моменты, развиваемые приводами манипулятора.
Силы, действующие на звенья им
Введем следующие обозначения (рис.1.1):
Fв i – суммарный вектор внешних сил, приложенный к звену i, приведенный к центру масс звена i,
Fи i – вектор сил инерции i-го звена (приложен к центру масс звена i),
fi – вектор сил реакции, приложенный к звену i в месте сочленения звеньев i-1 и i (в точке, совпадающей с центром СКi-1).
fi – вектор сил реакции, приложенный к звену i-1 в месте сочленения звеньев i-1 и i.
СКn
fn(0)
СКn-1
rn
CКi
Fвn(0)
-
fi+1(0)
Fвi(0)
CКi-
1
ri
Fиn(0)
-fn(0)
Fиi(0)
fi(0)
-fi(0)
СК0
Рис.1.1. Силы, действующие на звенья ИМ.
Составим уравнения кинето-статического равновесия каждого из тел под действием внешних сил, сил реакций и сил инерции. В проекциях на оси СК0:
Fвn
(0) +
Fиn(0)
+
fn
(0)
= 0,
Fвn-1 (0) + Fиn-1(0) + fn-1 (0) - fn (0) = 0,
…
Fвi (0) + Fиi(0) + fi (0) - fi+1 (0) = 0,
…
Fв10) + Fи1(0) + f1(0) - f2 (0) = 0.
Из всех сил, действующих на каждое из звеньев незвестны только силы реакции. Выполнив последовательно, начиная от звена n, подстановку значений сил реакции в уравнения для n-1, n-2, …1 звеньев, получим последовательно:
fn (0) = - (Fвn (0) + Fиn(0)),
fn-1 (0) = - (Fвn-1 (0) + Fиn-1(0) ) + fn (0) ,
…
fi (0) = - (Fвi (0) + Fиi(0) ) +fi+1 (0) = 0,
…
f1(0) = - (Fв10) + Fи1(0) ) + f2 (0) = 0
и
n
f i(0) = - (Fвj (0) + Fиj(0)),
j =i
i = 1,2,…,n.
Выражение для Fиj(0) имеет вид
Fиj(0) = - mj V` (0)j
поэтому n
f i(0) = (mj V` (0)j - Fвj (0) ),
j =i
i = 1,2,…,n.
Полученныве выражения совместно с выражениями для V` (0)j позволяют определить силы, действующие на звенья ИМ при его движении. Из них следует, что к звену i приложены все внешние силы, действующие на звенья с номерами от i до n, а также - силы инерции, обусловленные движением всех звеньев ИМ. На первое звено ИМ действуют все внешние силы и силы инерции всех звеньев. Сила реакции со стороны основания ИМ (действует на первое звено) равна f1(0). ИМ воздействует на основание с силой (-f 1(0)).
Замечание. Перед подстановкой в выражение для f i(0) в формулы для расчета V` (0)j следует положить tj = rj.
/* ДРУГОЙ ВАРИАНТ ВЫКЛАДОК (ЛЕКЦИИ 2011)
Рассмотрим участок кинематической цепи, начиная от звена i. Согласно принципу Даламбера этот участок кинемсатической цепт находтся в равновесии под действием всех внешних сил и всех сил инерции, действующих на звенья от i до n и сил реакции связей действующих на звено i, что эквивалентно записи
n
f i(0) + (Fвj (0) + Fиj(0)) = 0,
j =i
i = 1,2,…,n,
или n
f i(0) = (mj V` (0)j - Fвj (0) ),
j =i
i = 1,2,…,n.
*/
.
