- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 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. Пример расчета матрицы инерционных коэффициентов.
Координаты шарниров
- i - угол поворота звена i относительно звена i-1 вокруг оси Zi-1, если i = [ВП] (рис. 1.2);
si - линейное перемещение звена i относительно звена i-1 вдоль оси Zi-1, если i = [ПП].
Замечание:
“i = [ВП]” следует читать “сочленение i – вращательного типа»,
“i = [ПП]” следует читать “сочленение i – поступательного типа»,
i = 1,2,…,n.
Нулевые координаты сочленений соответствуют положению ИМ, которое принимается за исходное.
Рис.1.2. Координаты сочленений ИМ
Параметры им
Параметры кинематической схемы.
n – число звеньев ИМ,
= {i } - вектор (nx1) индикаторов типов i сочленений,
в котором (i = 1, если i-й шарнир – ВШ (ВП) и i = 0, если i-е сочленение – ПШ (ПП)); i = 1,2,…,n.
Конструктивные (геометрические) параметры звеньев ИМ (рис.1.3).
Углы установки осей СК смежных звеньев i, i,, i – три угла, на которые
следует повернуть СКi-1 последовательно вокруг осей Xi-1, Yi-1, Zi-1, так, чтобы оси СКi-1 стали параллельны соответствующим осям СКi при значении i = 0 (в исходном положении i-го сочленения); i = 1,2,…,n.
Длина звена i – вектор li, проведенный из начала СКi-1 к началу СКi при значении si = 0 (в исходном положении i-го сочленения); вектор li задается в проекциях на оси СКi : li(i) = { lix liy liz }T;
i = 1,2,…,n.
Yi
Zi-1
Zi
li(i)
i
Рис.1.3. Конструктивные
параметры ИМ
Xi
Xi-1
i
i
Yi-1
Пояснение. Отсчет углов установки шарниров и длин звеньев производится при нулевых значениях координат сочленений.
Инерционные параметры звеньев ИМ (рис.1.4).
Yi
Zic
Zi
Yic
ri(i)
Xi
Xic
Рис. 1.4. Инерционные параметры звеньев ИМ
mi - масса звена i; i = 1,2,…,n,
ri - вектор координат центра масс звена i - вектор, проведенный из
начала СКi в центр масс звена i; вектор ri задается в проекциях на оси СКi : ri(i) = {rix riy riz}T ; i = 1,2,…,n,
Ii - тензор инерции звена i в системе координат СКiс, оси которой
параллельны осям СКi , а начало совмещено с центром масс звена i; i = 1,2,…,n.
Тензор инерции – матрица размера (3х3):
Ii
=
Диагональные элементы матрицы Ii - моменты инерции звена i относительно осей СКiс (центральные, осевые моменты инерции); недиагональные элементы – смешанные моменты инерции.
Iхх i = i m i (yi 2 + zi 2) , Iyy i = i m i (xi 2 + zi 2), Iяя i = i m i (xi 2 + yi 2), -
осевые моменты инерции,
I хy i = - i m i (xi yi ) , I yz i = - i m i (zi yi ) , I xz i = - i m i (zi xi ), …
где m i - масса -й точки i- го звена, xi , yi , zi - координаты этой точки.
Замечание. У большого числа ИМ тензоры инерции звеньев могут быть представлены в виде матриц диагонального вида.
Замечание. Если звенья ИМ - твердые тела, конструктивные и инерционные параметры ИМ имеют постоянные (для данного ИМ) значения. Если звенья ИМ – упругие тела, эти параметры ИМ (за исключением масс звеньев) зависят от параметров упругой деформации звеньев и являются переменными.