- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 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.4. Производные по времени матриц преобразований поворота.
3.4.1. Запись производной по времени матрицы I-1i
Матрица `i-1i равна
`i-1i = i-1i (i),
где обозначено (*) – матрица (3х3) векторного произведения, составленная из элементов вектора
* = {*x *y *z }T :
0 - *z
*y
(.) = *z 0 - *x
-*y *x 0
Матрица используется при записи векторного произведения в координатной форме.
3.4.2. Свойства матрицы векторного произведения (.)
а) T(.) = - (.); следует из того, что (.) – кососимметрическая матрица.
б) Если a, b – 3-мерные векторы, то векторное произведение axb в координатной форме записи равно (a)b, что непосредственно следует из свойств векторного произведения.
в) (a)b = -(b)a; непосредственно следует из свойств векторного произведения.
г) (a(i)b(i) = ij (a(j)b(j) = (ij a(j)ijb(j); следует из свойств векторного произведения: результат векторного произведения не зависит от СК, в которой оно выполнено. Представленные соотношения можно переписать иначе:
(a(j)b(j) = Tij (ij a(j)ijb(j) .
Поскольку представленные соотношения справедливы для любого вектора b(j), b(j) можно опустить:
(a(j) = Tij (ij a(j)ij.
Последнее выражение можно переписать так
(ij a(j) = Tij (a(j)ij,
i i
д) ( ak(j)) = (ak(j)) . Это соотношение очевидно.
k=1 k=1
3.4.3. Вычисление `I-1i .
В справедливости выражений п.3.4.1 нетрудно убедиться, выполнив предписанные ими действия:
`i-1i = z` T(iqi) iT = (d
| cos (iqi) -sin (iqi) 0 |
| sin (iqi) cos (iqi) 0 | / dt ) iT =
| 0 0 1 |
- sin(iqi) - cos(iqi) 0 cos (iqi) -sin (iqi) 0 0 -1 0
cos (iqi) - sin(iqi) 0 iT iqi` = sin (iqi) cos (iqi) 0 1 0 0 iT iqi` =
0 0 0 0 0 1 0 0 0
zT(iqi) (e) iT iqi` = zT(iqi) (iT (i e) ) iT iqi` = zT(iqi)iT (vi) iiT iqi` =
zT(iqi)iT (vi iqi` ) = i-1i (i),
3.4.4. Производная по времени матрицы 0i.
Продифференцируем выражение для 0i по времени; получим
i i
`0i = d ( П k-1 k )/dt = 0 k-1`k-1 kki = 0 k-1 k-1k (k) ki =
k=1 k=1
0 k (k) k00 k ki = 0k (k) k00i = ( 0kk) 0i = (0k k) 0i =
(i(0)) 0i.
Или
`0i = (i(0)) 0i.
