- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 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. Пример расчета матрицы инерционных коэффициентов.
Угловые и линейные ускорения звеньев
4.1. Угловые ускорения
Продифференцируем i (0) по времени. Получим:
i i i i
`i (0) = `0jj + 0j`j = (j(0)) 0jj + 0j`j,
j =1 j =1 j =1 j =1
или в развернутой форме записи
i i
`i (0) = (j(0)) 0jvjjqj` + 0j vjjq``j ,
j =1 j =1
где
j
j(0) = 0kvkk qk` .
k =1
С другой стороны, из полученных ранее соотношений следует
i i
`i (0) = с`j(0) qj` + сj(0) q``j.
j =1 j =1
Сравнив между собой cоотношения (4.1) и (4.2), увидим:
с`j(0) = (j(0)) 0jvjj = (j(0)) сj(0) .
Из полученных соотношений следует, что угловые ускорения звеньев ИМ линейно зависят от вторых производных обобщенных координат (зависимость задается векторами сj(0) ) и квадратично – от первых производных обобщенных координат ИМ.
4.2. Линейные ускорения
Продифференцируем Vi (0) по времени. Получим:
i
V`i(0) = (`i(0)) 0i ti + (i(0)) `0i ti + (`j(0)) 0j (vj (1-j)qj + lj) +
j=1
i i
(j(0)) `0j (vj (1-j)qj + lj) + (j(0)) 0j (vj (1-j)q`j) +
j=1 j=1
i i
`0j (vj (1-j)q`j) + 0j (vj (1-j)q``j).
j=1 j=1
После подстановки в полученное выражение значений `0j будем иметь:
i
V`i(0) = (`i(0)) 0i ti + (i(0)) (i(0)) 0i ti + (`j(0)) 0j (vj (1-j)qj + lj) +
j=1
i i
(j(0)) (j(0)) 0j (vj (1-j)qj + lj) + 2 (j(0)) 0j (vj (1-j)q`j) +
j=1 j=1
i
0j (vj (1-j)q``j).
j=1
С другой стороны, согласно вышеизложенному
i i
V`i(0) = D`ij(0) q`j + Dij(0) q``j.
j=1 j=1
Выражеие для Dij(0) мы получили ранее. Для того, чтобы полностью развернуть выражение для V`i(0) нужно определить вид D`ij(0) q`j.
Обратим внимание на 1-е, 3-е и последнее слагаемые в выражении для V`i(0):
i i
(`i(0)) 0i ti + (`j(0)) 0j(vj (1-j)qj + lj) + 0j (vj (1-j)q``j) =
j=1 j=1
i i
( (j(0)) 0jvjjqj` + 0j vjjq``j ) 0iti +
j =1 j =1
i k k
( (j(0)) 0jvjjqj` + 0j vjjq``j ) 0j k(v k (1- k)q k + l k) +
k =1 j =1 j =1
i
0j (vj (1-j)q``j) =
j=1
(во втором слагаемом переименованы индексы j и k – для удобства дальнейших преобразований)
i i k i
( 0j vjjq``j ) 0iti + ( 0j vjjq``j ) 0 k(v k(1- k)q k + lj) + 0j (vj (1-j)q``j) +
j =1 k =1 j =1 j=1
i i k
( (j(0)) 0jvjjqj` ) 0iti + ( (j(0)) 0jvjjqj` ) 0 k(v k (1- k)q k + l k) =
j =1 k =1 j =1
i i k i
(0j vjj) 0iti q``j + (0j vjj) 0 k(v k (1- k)+q k l k) q``j + 0j (vj (1-j) q``j +
j =1 k =1 j =1 j=1
i i k
( (j(0)) 0jvjjqj` ) 0iti + ( (j(0)) 0jvjjqj` ) 0 k(v k (1- k)q k + l k) =
j =1 k =1 j =1
i
Dij(0) q``j + … .
j=1
(Мы воспользовались результатами вывода формулы линейной скорости звеньев).
i
Тогда D`ij(0) q`j - это 2,4,5 слагаемые из выражения для V`i(0) + оставшиеся (…)
j=1
слагаемые из последнего выражения, т.е.
i
D`ij(0) q`j = (i(0)) (i(0)) 0i ti +
j=1
i i
(j(0)) (j(0)) 0j (vj (1-j)qj + lj) + 2 (j(0)) 0j (vj (1-j)q`j) +
j=1 j=1
i i k
( (j(0)) 0jvjjqj` ) 0iti + ( (j(0)) 0jvjjqj` ) 0 k(v k(1- k)q k + l k).
j =1 k =1 j =1
ДРУГОЙ ВАРИАНТ ВЫКЛАДОК (лекции 2011).
/* … Обратим внимание на 1-е, 3-е и последнее слагаемые в выражении для V`i(0):
i i
(`i(0)) 0i ti + (`j(0)) 0j(vj (1-j)qj + lj) + 0j (vj (1-j)q``j) =
j=1 j=1
i i
( (j(0)) 0jvjjqj` + 0j vjjq``j ) 0iti +
j =1 j =1
i k k
( (j(0)) 0jvjjqj` + 0j vjjq``j ) 0j k(v k (1- k)q k + l k) +
k =1 j =1 j =1
i
0j (vj (1-j)q``j).
j=1
В последнем равенстве 2-е, 3-е и 5-е слагаемые являются явными функциями q``j . Но согласно
i i
V`i(0) = D`ij(0) q`j + Dij(0) q``j
j=1 j=1
и эти слагаемые равны
i
Dij(0) q``j.
j=1
Тогда
i
D`ij(0) q`j -
j=1
это все оставшиеся слагаемые, а именно (см. выше).
*/
В этих слагаемых каждая компонента содержит произведения производных обобщенных координат второй степени. Поэтому линейные ускорения звеньев ИМ линейно зависят от вторых производных обообщенных координат (зависимость задается векторами Dij(0)) и квардратично – от первых производных обобщенных координат ИМ.
Внимательное рассмотрение последнего выражения дает компоненты вида
2(j(0))0j(vj(1-j)q`j) – ускорения Кориолиса, а также центробежные (пропорциональные вторым степеням производных одноименных координат вращательных пар и гироскопические ускорения (пропорциональные произведениям производных разноименных координат).
