- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 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.6. Свойства векторов Dij(0)
а) Dj(0) - орт оси Zj-1, спроецированный на оси СК0., если j = [ПП].
б) Dij(0) = (0j vjj) Rij(0), если j = [ВП].
г) |Dj(0) | = 1, если j = [ПП] .
е) Rij(0) - есть вектор, проведенный из начала СКj-1 к точке на звене i, скорость которой определяется, рассматриваемый в проекциях на оси СК0.
ж) | Rij(0) | - длина вектора, проведенного из начала СКj-1 к точке на звене i, скорость которой определяется.
з) | Dij(0) | = площади прямоугольника, построенного на векторах сj(0) и Rij(0) как на сторонах. Поскольку |сj(0)| = 1, |Dij(0)| численно равен длине перпендикуляра, опущенного из конца вектора Rij(0) к линии вдоль вектора сj(0).
Геометрическая иллюстрация свойств векторов Dij(0) и Rij(0) дана на рис.3.1.
Dij(0)
(j
= [ПП])
CКi
|
(сj(0))
Rij(0)
|
Zj-1
i
Dij(0)
(j
= [ВП])
j
cj(0)
Rij(0)
CКj-1
СК0
Рис.3.1. Векторы Dij(0), Rij(0).
3.7. Матрицы-якобианы линейных скоростей им.
Из выражений для расчета линейных скосротей звеньев ИМ следует
Vn(0) = Dn(0)q`
где
Dn(0) = [Dn1(0) Dn2(0) … Dnn(0) ] -
матрица, составленные из векторов Dj (0) , имеющие размер (3хn).
Матрица Dn(0) линейно связывает между собой векторы производных по времени обобщенных координат ИМ и угловых скоростей последнего (n-го) звена ИМ и носит название матриц-якобианов линейных скоростей (n-го звена) ИМ.
Аналогично можно построить матрицу-якобиан Di(0) для любых других звеньев ИМ.
Важным является то, что с помощью этих матриц можно, зная производные по времени обобщенных координат ИМ (скоростей вращения шарниров), определить линейную скорость любого звена ИМ.
Зная Di(0) , можно составить блочную матрицу D(0) , в которой матрицы Di(0) представлены (блочными) строками размера (3хn) с соответствующими номерами. Размер блочных матриц – (3nхn).
С использованием таких блочных матриц ИМ можно записать выражения выражения для расчета угловых скоростей сразу всех звеньев ИМ:
V (0) = D(0) q` ,
где
V (0) = [V1(0)T V2(0)T … Vn(0)T ]T .
Элементы блочной матрицы D(0) = {Dij(0)} – векторы Dij (0) .
Поскольку в выражениях для расчета линейных скоростей суммирование ведется только до i, элементы матрицы D(0) следует принять равными нулю при j>i.
Блочная матрица D(0) носит название матрицы-якобиана линейных скоростей ИМ.
3.8. Матрица-якобиан последнего звена им.
Выпишем выражения для расчета линейных и угловых скоростей последних звеньев ИМ:
n(0)
= Cn(0)q`
Vn(0) = Dn(0)q`
С
оставим
теперь блочный вектор [n(0)
T Vn(0)
T]T
и блочную матрицу (0),
элементы которой сi
(0) и Dni(0)
:
с1(0) с2(0) … сn(0)
(0) = ------------------------ .
Dn1(0) Dn2(0) … Dnn(0)
Тогда систему уравнений (2.15) можно представить в виде одного уравнения
n(0)
--------- = (0) q` ,
Vn(0)
связывающего между собой векторы угловой и линейной скорости последнего звена ИМ в базовой (декартовой) СК, и вектор производных обобщенных координат ИМ.
Связь между обобщенными и декартовыми координатами – линейная. Матрица (0), связывающая между собой обобщенные и декартовы кординаты последнего звена ИМ, называется матрицей-якобианом скоростей ИМ или просто матрицей-якобианом.
На практике необходимо решать обе задачи. Решения прямой задачи позволяет установить скорость движения ИМ по известным показаниям датчиков скорости, установленных на валах приводов. Решение обратной кинематической задачи - определить сигналы управления на входах приводов (при управлении приводами по скорости), соответствующие заданной скорости движения ИМ. Для решение обратной кинематической задачи для скоростей ИМ применяют специальные приемы, позволяющие исключить возможные неоднозначности.
Если
при составлении матрицы (0)
использовать в качестве элементов
векторы сj(0)
и Dij(0)
, можно решать задачи расчета скоростей
любых других звеньев ИМ, а также обратные
задачи.
