- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 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.2):
Mв i – суммарный внешний момент, приложенный к звену i,
Mи i – вектор моментов сил инерции i-го звена (приложен к центру масс звена i),
i – вектор моментов сил реакции в месте сочленения звеньев i-1 и i, приложенный к звену i (к звену i-1 приложен равный по величине и противоположный по знаку вектор).
fn(0)
СКn
n(0)
ln
vn(1-n)qn
rn
СКn-1
CКi
Mвn(0)
CКi-
1
li
Mиn(0)
-fn(0)
-n(0)
ri
Mвi(0)
-i(0)
Mиi(0)
fi(0)
vi(1-i)qi
-fi-1(0)
i(0)
СК0
Рис.1.2. Моменты, действующие на звенья ИМ.
Составим уравнения кинето-статического равновесия каждого из тел под действием внешних моментов, моментов реакции и моментов сил инерции. В проекциях на оси СК0:
Mвn (0) + Mиn(0) + n (0) - (0n (vn (1-n)qn + ln + rn)) fn (0) = 0,
Mвn-1 (0) + Mиn-1(0) + n-1 (0) - n (0) –
(0n-1 (vn-1 (1-n-1)qn-1 + ln-1 + rn-1)) fn-1 (0) +(-0n-1 rn-1) (-fn (0) ) = 0,
…
Mвi (0) + Mиi(0) + i (0) - i+1 (0) –
(0i (vi (1-i)qi + li + ri)) fi (0) +(0i ri) fi+1 (0) = 0,
…
Mв1 (0) + Mи1(0) + 1 (0) - 2 (0) –
(01 (v1 (1-1)q1 + l1 + r1)) f1 (0) +(01 r1) f2 (0) = 0.
Из всех моментов, действующих на каждое из звеньев незвестны только моменты реакции. Выполнив последовательно, начиная от звена n, подстановку значений моментов реакции в уравнения для n-1, n-2, …1 звеньев, получим последовательно:
n (0) = - (Mвn (0) + Mиn(0)) + (0n (vn (1-n)qn + ln + rn)) fn (0) ,
n-1 (0) = - (Mвn-1 (0) + Mиn-1(0) ) + n (0) +
(0n-1 (vn-1 (1-n-1)qn-1 + ln-1 + rn-1)) fn-1 (0) - (0n-1 rn-1) fn (0),
…
i (0) = - (Mвi (0) + Mиi(0) ) + i+1 (0) +
(0i (vi (1-i)qi + li + ri)) fi (0) - (0i ri) fi+1 (0),
…
1 (0) = - (Mв1 (0) + Mи1(0) ) + 2 (0) +
(01 (v1 (1-1)q1 + l1 + r1)) f1 (0) -(01 r1) f2 (0).
и
n (0) = - (Mвn (0) + Mиn(0)) + (0n (vn (1-n)qn + ln + rn)) fn (0) ,
n
n-1 (0) = - (Mвj (0) + Mиj(0) ) +
n j=n-1
(0j (vnj (1-j)qj + lj + rj)) fj (0) - (0n-1 rn-1) fn (0),
j=n-1
…
n
i (0) = - (Mвj(0) + Mиj(0) ) +
j=i
n n-1
(0j (vj (1-j)qj + lj + rj)) fj (0) - (0j rj) fj+1 (0),
j=i j=i
…
n
1 (0) = - (Mвj (0) + Mиj(0) ) +
j=1
n n-1
(0j (vj (1-j)qj + lj + rj)) fj (0) - (0j rj) fj+1 (0).
j=1 j=1
Учитывая, что
n
f j0) = - (Fвk (0) + Fиk(0)),
k =j
запишем выражение для i (0):
n
i (0) = - (Mвj (0) + Mиj(0) ) -
j=i
n n n-1 n
(0j (vj (1-j)qj + lj + rj)) (Fвk (0) + Fиk(0)) + (0j rj) (Fвk (0) + Fиk(0)) =
j=i k=j j=i k=j+1
n n n
- (Mвj (0) + Mиj(0) ) - (0j (vj (1-j)qj + lj) (Fвk (0) + Fиk(0)) -
j=i j=i k=j
n n n-1 n
(0j rj) (Fвk (0) + Fиk(0)) + (0j rj) (Fвk (0) + Fиk(0)) .
j=i k=j j=i k=j+1
