- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 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. Пример расчета матрицы инерционных коэффициентов.
1.6.2. Матрицы композиции элементарных поворотов
Любой пространственный поворот СК можно представить как композицию трех элементарных поворотов. Так например, если СК {uvw} образована в результаты выполнения трех последовательных поворотов относительно СК {xyz}: вначале – вокруг оси х (новую СК обозначим {uv`w`}), затем (после первого поворота) – вокруг оси v` (новую СК обозначим {u`v`w``}), затем (после двух первых поворотов – вокруг оси w`` - СК {u``v``w``}), то матрица композиции этих преобразований может быть получена путем перемножения матриц элементарных поворотов, так
xyz, uvw = xyz, uvw (СК {uvw}, ось u, угол ) xyz, uvw (СК {uvw}, ось v`, угол ) xyz, uvw (СК {uvw}, ось w``, угол )
Отметим, что последовательность элементарных поворотов может быть различной (например: вначале v, затем u, затем w). Поэтому при определении матрицы композиции преобразований нужно указывать последовательность применения преобразований.
При написании последовательности операторов поворота учитываем, что осуществляются последовательные повороты СК {uvw} вместе с закреплённым с ней вектором относительно СК {xyz} в заданном порядке (ось u, ось v`, ось w``), но координаты векторов из СК {uvw} к СК {xyz} преобразуются в обратном порядке! Поэтому матрица первого поворота – самая первая слева (последнее преобразование вектора из СК {uvw} в СК {xyz}). Матрица последнего поворотоа – самая последняя слева (первое преобразование вектора из СК {uvw} в СК {xyz}).
Этот факт иллюстрирует рисунок 1.10. Зеленый цвет – последовательность поворотов ск. Синий – последовательность преобразований векторов, заданных координатами в подвижной ск, в неподвижную.
v``
w``
v`
w`
w``
u``
v`
u`
u
u`
z
v`
w`
y
х,
u
Рис. 1.10. Последовательности преобразований
1.6.3. Матрицы сложных поворотов
Матрица преобразования поворота СКuvw относительно СК xyz может быть представлена как последовательность двух и более поворотов:
xyz, uvw = xyz, uvw (1) … xyz, uvw (n-1) xyz, uvw (n),
где uvw, xyz (i) – матрица i-го поворота (композиция элементарных поворотов или отдельные элементарные повороты).
Если, например, i-1, i – матрица поворота СКi относительно СКi-1 , то матрицу поворота СКi относительно СК0 можно представить в виде
i
0i = П k-1 k = 01 12 23 … n-1 n
k=1
Матрицы сложных поворотов можно представить в рекуррентрной форме
0i = 0i-1 i-1 i , i = 1,2,…,n.
1.6.4. Матрицы поворота ск смежных звеньев им
Положение в пространстве СКi относительно СКi-1 можно задать, выполнив последовательно четыре поворота СКi , – вокруг оси Zi на угол iqi , затем последовательно вокруг осей X i`, Y i``, Z i```.
Поэтому матрица поворота СКi относительно CКi-1 может быть записана в виде
i-1i = i-1i (ось Z i, угол iqi) i-1i (осьXi`,угол i)х
i-1i (осьYi``,угол i) i-1i (ось Zi```, угол i) .
Используя матрицу i-1i , можно определить координаты вектора, заданного в СК i , в СК i-1 :
a(i-1) = i-1 i a(i),
Обратное преобразование запишется так:
a(i) = i i-1 a(i-1) .
Матрицы i-1 i и i i-1 связаны соотношениями
i-1 i = T i i-1 .
С учетом введенных в п.1.6.1 обозначений можно записать
i i-1 = z(i)y(i)x(i)z(iqi). (1.4)
