- •П. К. Лопатин Интеллектуальные манипуляционные роботы
- •Предисловие
- •Введение
- •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.8. “Уравнение кинематики манипулятора”), а искусственную руку. Впоследствии мы увидим, что механика “руки” не отличается принципиально от механики “человека”.
С точки зрения механики, человеческая рука – это совокупность твердых тел (плечо, предплечье, кисть), связанных друг с другом, но способных двигаться друг относительно друга.
Искусственную руку представим схемой (рис. 1).
Нулевым звеном является неподвижная стойка, к ней крепится первое звено (подвижное), к нему – второе и т.д. Последним звеном является схват. В каждое звено вставлен двигатель, который приводит в движение следующее звено. Такую руку и будем называть роботом, или манипулятором.
Нам нужно, чтобы рука двигалась требуемым для нас образом. Следовательно, мы должны найти способ описания движения. Этот способ будет предложен в гл.1 “Кинематика манипуляторов”. Известно, что тела движутся под воздействием приложенных к ним сил. По описанию движения мы должны уметь вычислять силы, которые нужно будет приложить к звеньям робота. Уравнение, по которому вычисляются силовые воздействия, будет выведено в гл.2 “Динамика манипуляторов”. Силовые воздействия к звеньям будут прилагать двигатели. Для того, чтобы двигатели развивали требуемые силовые воздействия, на них нужно подавать соответствующие токи (электро-, гидро- или пневмотоки, в зависимости от используемого привода). Уравнение, связывающее токи с силовыми воздействиями, выводится при изучении курса «Приводы манипуляционных роботов» и здесь не рассматривается. Все расчеты должны производиться автоматически. Эту функцию может исполнить ЭВМ. Вопросы планирования траектории движения в различных средах и обеспечения устойчивого движения по спланированной траектории будут рассмотрены в гл.3 «Планирование путей и управление манипуляторами».
Итак, получаем схему управления манипуляторами (рис. 2).
Здесь ЦАП – цифро-аналоговый преобразователь; Д – двигатели; З – звенья; Тц – числа в электронной форме; выдаваемые ЭВМ в каждый момент времени на ЦАП и указывающие, какой величины должен быть ток в данный момент; Тр - реальные токи, подаваемые на двигатели; с – силы, прилагаемые двигателями к звеньям; тр – траектория, исполняемая звеньями.