- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 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. Пример расчета матрицы инерционных коэффициентов.
3.5. Линейные скорости звеньев им
Соотношения для определения линейных скоростей звеньев получим, продифференцировав выражения для Vi(0) по времени:
i i
Vi(0) = t`i(0) = `0i ti + `0k (vk (1-k)qk + lk) + 0j (vj (1-j)q`j).
k=1 j=1
(Различные индексы суммирования во втором и третьем слагаемых приняты для удобства дальнейших преобразований).
Подставив сюда значения `0k = (k(0)) 0k, получим
i i
Vi(0) = t`i(0) = (i(0)) 0i ti + (j(0)) 0j (vj (1-j)qj + lj) + 0j (vj (1-j)q`j).
j=1 j=1
Развернем полученное выражение, подставив в него
k
k (0) = 0jvjjq`j .
j =1
Получим: I I
Vi(0) = `0iti + `0k(vk (1-k)qk + lk) + 0j(vj (1-j)q`j) =
k=1 j=1
i i k
(0jvjj) 0iti qj` + (0jvjj) 0k(vk (1-k)qk + lk) qj` +
j=1 k=1 j=1
i
0j vj (1-j) q`j.
j=1
Покажем, что полученное выражение можно представить в следующем виде:
i
Vi(0) = Dij(0) q`j ,
j=1
где
Dij(0) = (0j vjj) Rij(0) + 0j vj (1-j)= (сj(0)) Rij(0) + 0j vj (1-j),
i
Rij(0) = 0iti + 0k (vk (1-k)qk + lk).
k=j
Доказательство.
Для 0j vj (1-j) все очевидно (из третьего слагаемого выражения для Vi(0)).
(сj(0)) Rij(0) получается в результате преобразований двух первых слагаемых. Первое слагаемое из выражения для Vi(0) в выражение для Rij(0) переходит непосредственно. Докажем, что второе слагаемое в Rij(0) можно получить, преобразовав второе слагаемое в Vi(0) путем изменения порядка и пределов суммирования.
В самом деле:
i k i i
(0jvjj) 0k(vk (1-k)qk + lk) qj` = (0j vjj) 0k (vk (1-k)qk + lk) qj` =
k=1 j=1 j=1 k=j
i i
(0j vjj) 0k (vk (1-k)qk + lk) qj`.
j=1 k=j
Пояснение.
До перестановки: k=1, j=1.
k=2, j=1,2.
…
k=i, j=1,2,…,i.
После перестановки:
j=1, k=1,…,i,
j=2, k=2,…,i,
…
j= i, k=i.
Можно видеть, что полученное выражение соответствует второму слагаемому Rij(0) , что и требовалось доказать.
Dij(0) - векторы размера (3х1).
