- •П. К. Лопатин Интеллектуальные манипуляционные роботы
- •Предисловие
- •Введение
- •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. Иерархия уровней Управления роботами
- •Примеры решения задач
- •Задачи для самостоятельного решения
- •Заключение
- •Учебное издание
- •Учебное пособие
4. Объединение свободных соединенных областей
Объединение соединенных областей происходит на основе матриц TFR и LCR для соединения свободных областей на каждой плоскости между собой. В результате на каждой плоскости будут получены одна или несколько объединенных областей, изолированных друг от друга. Внутри каждой из этих областей можно будет перемещаться от любой точки A к любой точке B, двигаясь пошагово на один дискрет (т.е. каждая область является связанной) (можно свободно перемещаться в пределах области). А переходить из одной изолированной объединенной области в другую на j-ой плоскости будет нельзя.
1) Создадим на основе матриц LCR новую матрицу – ETFR (Extension TFR) матрицу объединенных свободных областей для каждой плоскости.
2) Для этого поместим в матрицу ETFR номер первой строки матрицы LCR. Если в матрице LCR существуют другие пути (количество строк больше 1), то произведем сравнение путей в матрице LCR по значениям в столбцах.
2.1) Если в хотя бы одном i-ом столбце значения в j-ой и j+k строке совпадают, где j – это уникальный обнаруженный путь (первый считается уникальным по умолчанию), k=1, …, j-1, то в матрицу ETFR на j-ой строке следует добавить текущий номер пути (строки) матрицы LCR. Рассмотрим все i столбцов для всех пар j и j+k по ходу исключая из дальнейшего рассмотрения те области j+k, которые совпали с j-ой.
Например: если матрица LCR имеет вид , то матрица ETFR будет иметь вид , так как для путей представленных в первой и второй строке матрицы LCR первая ячейка этой плоскости общая т.к. и строка 1, и строка 2 содержат общий элемент в своем первом столбце, поэтому мы можем первый и второй путь матрицы LCR объединить в общую область и записать номера этих строк в одной строке матрицы ETFR. Третья строка матрицы LCR уникальна, так как элементы этой строки не совпадают с остальными строками по столбцам. Поэтому сформируем новую строку матрицы ETFR и запишем в неё 3 - номер строки уникального пути LCR.
Количество строк в матрице ETFR говорит о числе изолированных свободных областей.
2.2) Если обнаружен полностью уникальный путь, не совпадающий с предыдущим, то номер этой строки заносится в следующую строку матрицы ETFR. Заканчивается поиск общих областей для первого уникального пути, а затем начинается поиск совпадений для следующего уникального пути, исключая из рассмотрения те области, которые уже были найдены как совпадение раньше.
2.3) Если были найдены все уникальные пути и рассмотрены все возможные совпадения путей в матрице LCR, то переходим к построению ETFR для следующей матрицы LCR начиняя с шаг 1.
Матрица ETFR для примера (рис. 5, таблица 2) приведенного в предыдущих пунктах будет образована следующим образом:
Возьмем первую строку матрицы LCR2,I, как уникальный путь и запишем её номер в первую строку матрицы ETFR. Рассмотрим вторую строку. Сравним её с первой, сравнивая их значения по столбцам.
,
Уже в первом столбце их значения совпадают. Поэтому запишем в первую строку матрицы ETFR и номер второй строки матрицы LCR2,I Полученная матрица ETFR будет иметь вид:
,
что означает существует одно объединение свободных областей в котором есть два пути, которые представлены в 1-ой и 2-ой строке матрицы LCR.
Рассмотрим пример матриц ETFR для трехмерного случая, который представлен на рисунке 4. Матрица TFR для этого случая приведена в Таблице 3. Объединение свободных областей для каждой плоскости представлено на рисунке 14.
Построим матрицы ETFR для каждой плоскости:
|
|
|
Рисунок 14 - Объединение свободных областей