- •П. К. Лопатин Интеллектуальные манипуляционные роботы
- •Предисловие
- •Введение
- •1. Кинематика манипуляторов
- •1.1. Манипулятор как система твердых тел
- •1.2. Кинематика произвольного движения тела,
- •1.3. Кинематика поступательного движения тела
- •1.4. Кинематика произвольного движения твердого тела
- •1.5. Характер связей между звеньями
- •1.6. Расстановка систем координат по алгоритму Денавита-Хартенберга
- •1.7. Вывод матрицы перехода от I-й к (I–1)-й системе координат
- •1.8. Уравнение кинематики манипулятора
- •1.9. Скорость и ускорение некоторой точки манипулятора
- •Правая часть (1.45), если k j, k I;
- •0, Если k j.
- •1.10. Прямая задача кинематики
- •1.11. Обратная задача кинематики
- •Примеры решения задач
- •Разделим уравнение (1.71) на (1.72). Получим
- •Задачи для самостоятельного решения
- •Библиографический список
- •2.1. Уравнения Лагранжа II рода
- •2.2. Кинетическая энергия манипулятора
- •Поскольку интеграл – это сумма, то формулу (2.3) можно записать в виде уравнения
- •Из (1.36) следует, что
- •Из формулы (1.42) видно, что
- •2.3. Потенциальная энергия манипулятора
- •2.4. Уравнение динамики манипулятора
- •Примеры решения задач
- •Задачи для самостоятельного решения
- •3. Планирование путей, траекторий и управление манипуляторами
- •3.1. Понятие пространства обобщенных координат.
- •Постановки задачи
- •3.2. Планирование пути методом полиномиальной аппроксимации
- •Решая эту систему, получим
- •3.3. Планирование пути с учетом ограничений на положение, скорость и ускорение
- •3.4. Планирование траектории с учетом динамики манипулятора
- •Библиографический список
- •3.5. Исполнение траектории
- •Библиографический список
- •Библиографический список
- •3.6.1. Алгоритм полного перебора
- •Библиографический список
- •3.6.2. Алгоритм перебора в глубину
- •3.6.3. Алгоритм а*
- •Библиографический список
- •3.6.4. Алгоритм фронта волны
- •Библиографический список
- •3.6.5. Алгоритм полиномиальной апроксимации
- •Библиографический список
- •3.6.6. Диаграммы вороного
- •Библиографический список
- •3.6.7. Алгоритм разделения ячеек
- •1. Предварительный поиск маршрута
- •2. Разделение плоскости на свободные области
- •3. Соединение свободных областей
- •4. Объединение свободных соединенных областей
- •5. Соединение свободных областей на соседних плоскостях
- •6. Создание объединенных областей и проверка достижимости
- •7. Построение маршрута
- •8. Пример
- •Библиографический список
- •Примеры решения задач
- •3.7. Управление манипуляторами в среде с неизвестными препятствиями
- •Библиографический список
- •Алгоритм
- •3.8. Иерархия уровней Управления роботами
- •Примеры решения задач
- •Задачи для самостоятельного решения
- •Заключение
- •Учебное издание
- •Учебное пособие
1.3. Кинематика поступательного движения тела
относительно неподвижной системы координат
Рассмотрим случай, когда система Pixyz движется поступательно относительно неподвижной системы Pi-1xi-1yi-1zi-1 (рис. 1.8).
Нам известны законы изменения координат точки А в системе Pixyz. Они описываются вектором rA:
rA = . (1.18)
Мы хотим вычислить координаты точки А в системе Pi-1xi-1yi-1zi-1. Эти координаты будут описываться вектором ri-1A:
ri-1A = . (1.19)
В соответствии с рис. 1.8 получаем следующее выражение:
ri-1A = + rA, (1.20)
или, покоординатно,
= + . (1.21)
С помощью формулы (1.21) можно вычислить координаты произвольной точки в (i–1)-й системе координат, если мы знаем, как изменяются координаты этой точки в системе Oixyz.
1.4. Кинематика произвольного движения твердого тела
относительно неподвижной системы координат
Мы ставили перед собой задачу: зная координаты некоторой точки А в системе Pixiyizi, произвольно движущейся относительно неподвижной системы Pi-1xi-1yi-1zi-1, научиться вычислять координаты точки А в системе Pi-1xi-1yi-1zi-1. В результате наших исследований мы получили формулы (1.9) и (1.21). Преобразуя их, получаем:
= + . (1.22)
Перепишем формулу (1.22) в следующем виде:
= . (1.23)
Обозначим матрицу в (1.23) через Ti.
По формуле (1.23) можно вычислить координаты любой точки (а, следовательно, и всех точек) в (i–1)-й системе координат, если мы знаем координаты этой точки в i-й системе координат. Система Pixiyizi движется произвольно. Матрица Ti содержит 6 неизвестных величин: , , и какие-то 3 из направляющих косинусов. Тем самым мы переоткрыли известный в механике факт, утверждающий, что положение твердого тела, произвольно перемещающегося в пространстве, определяется шестью величинами. При этом величины , , определяют положение (удаленность) тела относительно неподвижной системы координат, а косинусы углов определяют ориентацию тела относительно неподвижной системы координат. Заметим также, что формула (1.23) останется действительной и для того случая, когда точка А не принадлежит i-му телу. Достаточно лишь знать ее координаты в i-й системе и мы получаем возможность вычислить координаты этой точки в (i–1)-й системе.
Мы рассмотрели движение свободного тела, т. е. самый общий случай. В манипуляторе же тела связаны друг с другом. В следующей главе определим характер этих связей и то, как они повлияют на вид матрицы Ti в формуле (1.23).
1.5. Характер связей между звеньями
Договоримся, что звенья манипулятора будут соединяться в кинематические пары 5-го класса (практически все манипуляторы, используемые в промышленности, состоят из кинематических пар 5-го класса).
Как известно, кинематической парой 5-го класса называются два тела, связанные друг с другом и способные перемещаться друг относительно друга, но так, что положение одного тела относительно другого полностью описывается одним параметром – углом поворота или величиной линейного смещения (рис. 1.9).
Кинематические пары 5-го класса бывают вращательными (рис. 1.9, а, б) и поступательными (рис. 1.9, в). Других пар 5-го класса не существует.
Во всех случаях (i–1)-е звено считаем неподвижным, а i-е звено – подвижным. Разумеется, за i-м звеном могут следовать и другие звенья, но в данном случае мы про них забываем.
Положение i-го звена относительно (i–1)-го полностью характеризуется в случае вращательной пары углом i, в случае поступательной пары – линейным смещением si.
Если мы хотим получить описание того, как i-е звено движется относительно (i–1)-го в течение некоторого времени, то нужно составить соответствующую функцию – i(t) (для вращательной пары) или si(t) (для поступательной пары).
Обратимся вновь к манипулятору. Для полного описания движения n-звенного манипулятора в пространстве нам необходимо знать n функций i(t) и si(t), описывающих движение звеньев друг относительно друга.
Обозначим функции, характеризующие движение звеньев друг относительно друга, через qi(t), i = 1,...,n. При этом будем иметь в виду, что qi(t) = = i(t), если пара вращательная, и qi(t) = si(t), если пара поступательная. Функции qi(t) называются обобщенными координатами манипулятора. Они объединяются в вектор обобщенных координат:
q(t) = . (1.24)
Пример. Вектор q(t) может иметь вид
q(t) = = . (1.25)
Вектор q(t) полностью описывает движение манипулятора в пространстве.