В настоящей статье рассматривается планирование траектории движения манипулятора в системе Matlab.
MATLAB (сокращение от англ. «Matrix Laboratory», в русском языке произносится как Матлаб) — пакет прикладных программ для решения задач технических вычислений и одноимённый язык программирования, используемый в этом пакете.
1. Общие сведения
Планирование траекторий движения манипулятора – это задача выбора закона управления, обеспечивающего движение манипулятора вдоль некоторой заданной траектории. Перед началом движения манипулятора важно знать:
1. существуют ли на его пути какие-либо препятствия;
2. накладываются ли какие-либо ограничения на траекторию схвата.
В зависимости от ответов на эти вопросы выбирается один из четырех типов управления манипулятором (табл. 1).
Таблица 1. Типы управления манипулятором
|
Препятствия на пути манипулятора
|
Присутствуют
|
Отсутствуют
|
Ограничения на траекторию манипулятора
|
Присутствуют
|
I. Автономное планирование траектории, обеспечивающее обход препятствий, плюс регулирование движения вдоль выбранной траектории в процессе работы манипулятора
|
II. Автономное планирование траектории плюс регулирование движения вдоль выбранной траектории в процессе работы манипулятора
|
Отсутствуют
|
III. Позиционное управление плюс обнаружение и обход препятствий в процессе движения
|
IV. Позиционное управление
|
Рассмотрим планирование траектории манипулятора при отсутствии препятствий (II и IV тип). Задача состоит в разработке математического аппарата для выбора и описания желаемого движения манипулятора между начальной и конечной точками траектории.
При планировании траекторий обычно применяется один из двух подходов:
1. Задается точный набор ограничений (например, непрерывность и гладкость) на положение, скорость и ускорение обобщенных координат манипулятора в некоторых (называемых узловыми) точках траектории. Планировщик траекторий после этого выбирает из некоторого класса функций (как правило, среди многочленов, степень которых не превышает некоторое заданное n) функцию, проходящую через узловые точки и удовлетворяющую в них заданным ограничениям. Определение ограничений и планирование траектории производится в присоединенных координатах.
2. Задается желаемая траектория манипулятора в виде некоторой аналитически описываемой функции, как, например, прямолинейную траекторию в декартовых координатах. Планировщик производит аппроксимацию заданной траектории в присоединенных или декартовых координатах.
Планирование в присоединенных переменных обладает тремя преимуществами:
1) задается поведение переменных, непосредственно управляемых в процессе движения манипулятора;
2) планирование траектории может осуществляться в реальном времени;
3) траектории в присоединенных переменных легче планировать.
4) Должны быть сведены к минимуму бесполезные движения типа «блуждания».
Рисунок 1. Блок-схема планировщика траекторий
Недостаток – сложность определения положения звеньев и схвата в процессе движения. Это необходимо для предотвращения столкновения с препятствием.
2. Реализация программы для расчёта траектории типа 4-3-4
Программа рассчитывает траекторию типа 4-3-4 для одного сочленения манипулятора при условии отсутствия препятствий.
На вход программы подаётся точный набор ограничений на положение, скорость и ускорение обобщенных координат манипулятора в узловых точках траектории.
Программа рассчитывает неизвестные коэффициенты
Результаты работы программы:
1. Ввод данных
Рисунок 2. Окна ввода входных данных
2. Полученные коэффициенты (вектор-столбец С):
Элемент матрицы коэффициентов C №1-1: 20
Элемент матрицы коэффициентов C №1-2: 40
Элемент матрицы коэффициентов C №1-3: 600
Элемент матрицы коэффициентов C №1-4: -1100.3559
Элемент матрицы коэффициентов C №1-5: 470.3559
Элемент матрицы коэффициентов C №2-1: 30
Элемент матрицы коэффициентов C №2-2: -269.4661
Элемент матрицы коэффициентов C №2-3: 272.4025
Элемент матрицы коэффициентов C №2-4: -12.9363
Элемент матрицы коэффициентов C №2-5: 0
Элемент матрицы коэффициентов C №3-1: 20
Элемент матрицы коэффициентов C №3-2: 91.3484
Элемент матрицы коэффициентов C №3-3: 25.9548
Элемент матрицы коэффициентов C №3-4: -195.9548
Элемент матрицы коэффициентов C №3-5: 118.6516
Сравним полученные коэффициенты с рассчитанными в (3), стр.
239:
Из приведённых данных следует, что полученные в ходе выполнения программы коэффициенты, верны.
3. Построение графиков положения, скорости и ускорения от времени.
Рисунок 3. График положения
Рисунок 4. График скорости
Рисунок 5. График ускорения
Текст программы: