Xreferat.com » Рефераты по промышленности и производству » Проектирование траектории перемещения роботов

Проектирование траектории перемещения роботов

Федеральное агентство по образованию

Пермский Государственный Технический Университет


Реферат:

«ПРОЕКТИРОВАНИЕ ТРАЕКТОРИЙ ПЕРЕМЕЩЕНИЯ РОБОТОВ»


ВВЕДЕНИЕ


Мы изучили, каким образом можно описать задачу робототехнического манипулирования при помощи однородных преобразований; теперь нужно рассмотреть методы проектирования траекторий перемещения робота.


Проектирование траектории перемещения роботов

Рис. 4.7.1. Робот, размещающий МОП-пластины. (С разрешения PRI.)


Нужно описать желаемые движения манипуляционных роботов либо в пространстве обобщенных координат, либо в трехмерном рабочем пространстве, либо в координатах схвата в зависимости от того, интересуют ли нас зависимости от времени положения, ориентации, линейной скорости, угловой скорости, линейного ускорения и углового ускорения (рис. 4.7.1).

С точки зрения интересов человека-оператора робототехническая система должна быть способна позаботиться о деталях траектории движения, как только введены преобразования, описывающие задачу. Например, оператор может просто ввести желаемое кинематическое положение схвата робота для манипулирования объектом и предоставить системе управления роботом планировать форму траектории перемещения и такие детали, как профили изменения скорости и ускорения. Это определенным образом связано с так называемым программированием на уровне задачи, которое будет рассмотрено и гл. 9. Мы же обратимся к вопросу о том, каким образом траектории перемещения роботов интерпретируются управляющей ЭВМ и каким образом управляющая ЭВМ в действительности строит такие траектории и выдает команды роботу на выполнение желаемых задач. Цифровой природой управляющей ЭВМ обусловлено то, что генерация траекторий осуществляется дискретным образом. Так, генерация каждой дискретной точки на траектории движения происходит за так называемое время просчета траектории. Точки могут генерироваться с частотой 10—300 Гц в зависимости от того, какая частота вычисления точек траектории может быть достигнута на управляющей ЭВМ. Задача состоит в том, чтобы переместить схват робота из начального кинематического положения Н(0) в заданное кинематическое положение H(t) за время t. Естественным представляется описать движение гораздо более детально, чем определить лишь начальную и конечную точки, с тем чтобы избежать столкновений с предметами, находящимися в рабочей области. Таким образом, определяются промежуточные точки, в которых должно быть найдено кинематическое положение схвата робота. Для более подробно описанных траекторий должны быть определены значения обобщенной скорости и обобщенного ускорения. Очевидно, чтобы получить изменяющееся во времени кинематическое положение схвата робота Н(t), необходимо прибегнуть к множеству изменяющихся во времени углов в сочленениях, или, иначе, к зависящему от времени вектору углов в сочленениях Q(t), такому, что


Проектирование траектории перемещения роботов Проектирование траектории перемещения роботов (4.7.1)


где Проектирование траектории перемещения роботов(t) - не что иное, как зависящее от времени решение об- ратной задачи кинематики с начальным Н(0) и конечным Н(t) кинематическими положениями схвата робота.

Далее мы опишем множество способов, применяемых для планирования и генерации желаемых векторов углов в сочленениях манипулятора.

КУБИЧЕСКИЕ ЗАКОНЫ ИЗМЕНЕНИЯ УГЛОВ В СОЧЛЕНЕНИЯХ


Простейший и наиболее часто используемый способ определения закона изменения угла в сочленении Проектирование траектории перемещения роботовi(t) - это определение начального и конечного значений Проектирование траектории перемещения роботовi(t) и Проектирование траектории перемещения роботовi(t), которые обычно принимают следующие значения:


Проектирование траектории перемещения роботовi(0) = Проектирование траектории перемещения роботовi0 (4.7.2)

Проектирование траектории перемещения роботовi(tf) = Проектирование траектории перемещения роботовif (4.7.3)

Проектирование траектории перемещения роботовi(0) = 0 (4.7.4)

Проектирование траектории перемещения роботовi(tf) = 0 (4.7.5)


где tf — конечный момент времени, а к схвату робота предъявляется требование, чтобы он находился в состоянии покоя в начальный момент времени t=0 и достигал состояния покоя в момент времени t = t.

Условиям (4.7.2) — (4.7.5) могут удовлетворить многочлены третьей степени от времени, т. е.


Проектирование траектории перемещения роботовi(t)= Проектирование траектории перемещения роботовi0 + a1it + a2it2 + a3it3, (4.7.6)


такие, что


Проектирование траектории перемещения роботовif = Проектирование траектории перемещения роботовi0 + a1itf + a2it2f + a3it3f, (4.7.7) 0 = a1i, (4.7.8)

0 = 2a2itf + 3a3itf, (4.7.9)


откуда a2i и a3i получаются равными

a2i = 3(Проектирование траектории перемещения роботовif - Проектирование траектории перемещения роботовi0 ) t -2f, (4.7.10)

a3i = 2(Проектирование траектории перемещения роботовif - Проектирование траектории перемещения роботовi0 ) t -3f. (4.7.11)


Если начальная и конечная скорости не равны нулю, как в ситуации с роботом, отслеживающим движение конвейера, коэффициенты полинома получаются из условий выполнения следующих ограничений:


Проектирование траектории перемещения роботовi(0) = Проектирование траектории перемещения роботовi0 , (4.7.12)

Проектирование траектории перемещения роботовi(tf) =Проектирование траектории перемещения роботовif. (4.7.13)


После этого легко определить коэффициенты в формуле (4.7.6):


aix = Проектирование траектории перемещения роботовi0 , (4.7.14)

a2i = 3(Проектирование траектории перемещения роботовif - Проектирование траектории перемещения роботовi0 ) t -2f - Проектирование траектории перемещения роботовi0 tf -1 - Проектирование траектории перемещения роботовif tf -1 (4.7.15)

a3i = 2(Проектирование траектории перемещения роботовif - Проектирование траектории перемещения роботовi0 ) t -3f + (Проектирование траектории перемещения роботовi0 + Проектирование траектории перемещения роботовif), (4.7.16)


Заметим, что соотношения (4.7.14) — (4.7.16) носят достаточно общий характер, чтобы быть применимыми к любой промежуточной точке между начальной и конечной точками траектории. Однако вследствие требования непрерывности положения, скорости и ускорения решение уравнений относительно коэффициентов становится более сложным.

Пример 4.7.1

Найдите коэффициенты для двух кубических законов изменения углов в сочленениях, приняв равными продолжительности прохождения по обоим участкам траектории. Решение. Заметим, что в этом случае для первого и второго участков траектории движения

Проектирование траектории перемещения роботов1(t)= a10 + a11t + a12t2 + a13t3, (4.7.17)

Проектирование траектории перемещения роботов2(t)= a20 + a21t + a22t2 + a23t3. (4.7.18)


Ограничения имеют вид

Проектирование траектории перемещения роботов1(0) = Проектирование траектории перемещения роботов10, Проектирование траектории перемещения роботов2(0)=Проектирование траектории перемещения роботов1(tf1); (4.7.19) Проектирование траектории перемещения роботов1(t)=Проектирование траектории перемещения роботов10, Проектирование траектории перемещения роботов2(0)=Проектирование траектории перемещения роботов1(tf1); (4.7.20)

Проектирование траектории перемещения роботов2(tf2)=Проектирование траектории перемещения роботов2f, Проектирование траектории перемещения роботов2(tf2)=Проектирование траектории перемещения роботов2f; (4.7.21)

Проектирование траектории перемещения роботов1(0) = Проектирование траектории перемещения роботов10, Проектирование траектории перемещения роботов2(0)= Проектирование траектории перемещения роботов1(tf1); (4.7.22)


Из приведенных восьми формул могут быть найдены восемь коэффициентов a10, a11, a12, a13, a20, a21, a22, и a23 (см.домашнее задание 6)


Проектирование траектории перемещения роботов

Рис. 4.7.5. Сложное движение манипулятора.


ОБЩИЕ АСПЕКТЫ ПЛАНИРОВАНИЯ ТРАЕКТОРИЙ


Вообще говоря, при планировании траектории робота нужно учитывать следующие обстоятельства.

1. Когда схват поднимает предмет, его движение должно быть направлено от опорной поверхности, чтобы избежать столкновения с ней.

2. Конечная точка подъема предмета должна лежать на нормали к поверхности, а начало системы координат схвата должно пройти через эту точку. Таким образом, будет обеспечено допустимое движение схвата. Контроль за скоростью, с которой должен подниматься предмет, может осуществляться путем слежения за временем, требуемым для перехода в эту точку.

3. Расстояние от конечной точки подъема до опорной поверхности рекомендуется выбирать равным не меньше 25 % длины последнего звена робота (0.25d6 + длина инструмента) (рис. 4.8.1).

4. Требования 1 - 3 относятся и к начальной точке спуска, т. е. схват должен перемещаться в направлении, перпендикулярном поверхности, и замедляться при подходе к опорной поверхности.

5. Из приведенных выше соображений следует, что на каждой траектории робота имеются четыре типа точек - начальная точка, конечная точка подъема, начальная точка спуска, конечная точка (рис. 4.8.2).

Таким образом, на процесс планирования траектории можно наложить следующие ограничения.

1. Начальное положение фиксировано.

2. Начальная скорость обычно равна нулю.

3. Начальное ускорение обычно равно нулю.

4. Конечное положение фиксировано.

5. Конечная скорость обычно равна нулю.

6. Конечное ускорение обычно равно нулю.

7. Конечная точка подъема должна находиться от опорной поверхности на расстоянии 0.25 d6 + длина инструмента.

8. Начальная точка спуска должна находиться от опорной поверхности на расстоянии 0.25 d6 + длина инструмента.


Проектирование траектории перемещения роботов

Рис. 4.8.1. Рекомендуемая конечная точка подъема.


Проектирование траектории перемещения роботов

Рис. 4.8.2. Типичная траектория движения i-го сочленения.


К перечисленным выше ограничениям можно также добавить, ограничения на скорость и ускорение в промежуточных положениях, т. е. в точках подъема и спуска. Однако, опустив эти ограничения, мы будем иметь восемь ограничений, которые можно было бы удовлетворить полиномом с неизвестными коэффициентами не менее чем седьмой степени. Так, для любого угла в сочленении Проектирование траектории перемещения роботовi можно записать


Проектирование траектории перемещения роботовi(t) =Проектирование траектории перемещения роботовani tn, (4.8.1)


где ani - элементы матрицы размера 8 x i.

Так как это выражение - полином седьмой степени, возможно, он будет иметь значительное число экстремумов (максимумов и минимумов), что было бы нежелательно для траекторий перемещения роботов. Кроме того, вычисление всех неизвестных коэффициентов может занять много времени (если i = 6,имеем 48 коэффициентов).


Ограничения, относящиеся к траекториям сочленений


Описание ограничения Уравнения ограничения

1


2


3


4


5


6


7


8


9


10


11


12


13


14

Начальное положение схвата


Начальная скорость робота


Начальное ускорение робота


Конечное положение робота при захвате


Непрерывность по положению в момент t1


Непрерывность по скорости в момент t1


Непрерывность по ускорению в момент t1


Начальное положение робота при установке


Непрерывность по положению в момент t2


Непрерывность по скорости в момент t2


Непрерывность по ускорению в момент t2


Конечное положение робота


Конечная скорость робота


Конечное ускорение робота

Проектирование траектории перемещения роботовi(t0) = Проектирование траектории перемещения роботов*i0

Проектирование траектории перемещения роботовi(t0) = Проектирование траектории перемещения роботов*i0

Проектирование траектории перемещения роботовi(t0) = Проектирование траектории перемещения роботов*i0

Проектирование траектории перемещения роботовi(t1) = Проектирование траектории перемещения роботов*i1

Проектирование траектории перемещения роботовi(t1-) = Проектирование траектории перемещения роботовi(t1+)

Проектирование траектории перемещения роботовi(t1-) = Проектирование траектории перемещения роботовi(t1+)

Проектирование траектории перемещения роботовi(t1-) = Проектирование траектории перемещения роботовi(t1+)

Проектирование траектории перемещения роботовi(t2) = Проектирование траектории перемещения роботов*i2

Проектирование траектории перемещения роботовi(t2-) = Проектирование траектории перемещения роботовi(t2+)

Проектирование траектории перемещения роботовi(t2-) = Проектирование траектории перемещения роботовi(t2+)

Проектирование траектории перемещения роботовi(t2-) = Проектирование траектории перемещения роботовi(t2+)

Проектирование траектории перемещения роботовi(t3) = Проектирование траектории перемещения роботов*i3

Проектирование траектории перемещения роботовi(t3) = Проектирование траектории перемещения роботов*i3

Проектирование траектории перемещения роботовi(t3) = Проектирование траектории перемещения роботов*i3


Проектирование траектории перемещения роботов

Рис. 4.8.3. Применение робота в лазерной резке.


Нужно также найти экстремальные значения на траектории перемещения робота с тем, чтобы убедиться, что эти экстремумы не выходят за рабочую поверхность. Таким образом, желательно прибегнуть к полиномам низких степеней путем деления траектории на участки, для которых вычисления выполняются сравнительно легко. Преимуществом таких полиномов низких степеней является то, что для них легче вычислить неизвестные коэффициенты и найти корни их производных при вычислении экстремумов.

Все такие разделенные на участки траектории должны быть непрерывны по положению, скорости и ускорению для достижения плавности движений робота. Для того чтобы это выполнялось, значения перечисленных параметров должны совладать на пересечениях участков.

Приняв во внимание все подобные ограничения, приходим, в конце концов к 14 ограничениям для вычисления неизвестных коэффициентов в точках пересечения трех участков траектории, т. е. траектории типа 4—3—4 и 3—5—3. Три участка начальный, промежуточный и конечный. В табл. 4.8.1 указаны 14 ограничений, относящихся к траекториям, разделенным на участки (рис. 4.8.3).

Чтобы полностью определить три полинома низкой степени при наложении приведенных выше 14 ограничений, сумма показателей степеней переменной t должна быть 14—3, потому что для этих трех различных полиномов имеются три свободных константы. Другими словами, должно быть 14 неизвестных, являющихся коэффициентами полиномов. Три из них являются свободными, так как оyи не умножаются на t. Таким образом, из-за того что полином m-й степени от t должен иметь m+1 коэффициентов, сумма степеней этих полиномов, относящихся к трем участкам, должна быть равна, по меньшей мере 11. Существует множество способов удовлетворить этому условию, в частности 4+3+4, 3+5+3 или 5+2+4. Рассмотрим подробнее некоторые из этих траекторий.


ТРАЕКТОРИЯ ТИПА 4 — 3 — 4


Для трех участков траектории перемещения, а именно: подъем, промежуточный участок и спуск, существуют полиномы четвертой, третьей и четвертой степеней, которые могут до- вольно хорошо аппроксимировать их. Для поиска решения на каждом из участков удобно ввести безразмерную переменную времени τ, такую, что


τ = Проектирование траектории перемещения роботов и τm = tm - tm-1


где индексы m и m-1 относятся к m-му и (m—1)-му участкам траектории движения робота. Таким образом, при движении по m-му участку траектории безразмерное время τ изменяется от 0 до 1, тогда как реальное время меняется от tm-1 до tm. Введение соотношений (4.8.2) значительно упростит выкладки.

Участок 1: Полином четвертой степени. Пусть ρmi(τ) является полиномиальным представлением m-го участка траектории движения для i-го сочленения. Тогда

ρ1i(τ) = Проектирование траектории перемещения роботовC1j τj = C10 + C11 τ + C12 τ2 + C13 τ3 + C14 τ4, (4.8.3)

τ1Проектирование траектории перемещения роботов1i(τ) = Проектирование траектории перемещения роботовjC1j τj-1 = C11 + 2C12 τ + 3C13 τ2 +4 C14 τ3 , (4.8.4)

τ21Проектирование траектории перемещения роботов1i(τ) = Проектирование траектории перемещения роботовj(j-1)C1j τj-2 = 2C12 + 6C13 τ +12 C14 τ2. (4.8.5)


Заметим, что эти полиномы должны удовлетворять ограничениям, приведенным в табл. 4.8.1. Таким образом,


ρ1i(0) = Проектирование траектории перемещения роботов*i0, Проектирование траектории перемещения роботовi(0) = Проектирование траектории перемещения роботов*i0, Проектирование траектории перемещения роботовi(0) = Проектирование траектории перемещения роботов*i0. (4.8.6)


Налагая приведенные ограничения на (4.8.3), (4.8.4) и (4.8.5), получим


ρ1i(τ) = C14 τ4+ C13 τ3 +Проектирование траектории перемещения роботовПроектирование траектории перемещения роботов*i0τ21 τ2 + Проектирование траектории перемещения роботов*i0 τ1 τ + Проектирование траектории перемещения роботов*i0. (4.8.7)


Пример 4.8.1

Определить закон движения схвата при подъеме.

Решение. Искомая зависимость относится к углу 9е и, следовательно, нужно положить i = 6 в (4.8.7). Таким образом,


ρ1i(τ) = C14 τ4+ C13 τ3 +Проектирование траектории перемещения роботовПроектирование траектории перемещения роботов*i0τ21 τ2 + Проектирование траектории перемещения роботов*i0 τ1 τ + Проектирование траектории перемещения роботов*i0 . (4.8.8)


Заметим, что в (4.8.7) имеются две неизвестные величины, которые нужно найти, — C14 и C13 ; они определяются из условий непрерывности:


Проектирование траектории перемещения роботов1i(1) = Проектирование траектории перемещения роботов2i(0), Проектирование траектории перемещения роботов1i(1) = Проектирование траектории перемещения роботов2i(0), Проектирование траектории перемещения роботов1i(1) =

Если Вам нужна помощь с академической работой (курсовая, контрольная, диплом, реферат и т.д.), обратитесь к нашим специалистам. Более 90000 специалистов готовы Вам помочь.
Бесплатные корректировки и доработки. Бесплатная оценка стоимости работы.
Подробнее

Поможем написать работу на аналогичную тему

Получить выполненную работу или консультацию специалиста по вашему учебному проекту
Нужна помощь в написании работы?
Мы - биржа профессиональных авторов (преподавателей и доцентов вузов). Пишем статьи РИНЦ, ВАК, Scopus. Помогаем в публикации. Правки вносим бесплатно.

Похожие рефераты: