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

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

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

Реферат:

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

ВВЕДЕНИЕ

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

Рис. 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(t_f) = _if (4.7.3)

_i(0) = 0 (4.7.4)

_i(t_f) = 0 (4.7.5)

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

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

_i(t)= _i0 + a_1it + a_2it² + a_3it³, (4.7.6)

такие, что

_if = _i0 + a_1it_f + a_2it²_f + a_3it³_f, (4.7.7) 0 = a_1i, (4.7.8)

0 = 2a_2it_f + 3a_3it_f, (4.7.9)

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

a_2i = 3(if - _i0 ) t ^-2_f, (4.7.10)

a_3i = 2(if - _i0 ) t ^-3_f. (4.7.11)

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

_i(0) = _i0 , (4.7.12)

_i(t_f) =_if. (4.7.13)

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

a_ix = _i0 , (4.7.14)

a_2i = 3(if - _i0 ) t ^-2_f - _i0 t_f ^-1 - _if t_f ^-1 (4.7.15)

a_3i = 2(if - _i0 ) t ^-3_f + (_i0 + _if), (4.7.16)

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

Пример 4.7.1

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

₁(t)= a₁₀ + a₁₁t + a₁₂t² + a₁₃t³, (4.7.17)

₂(t)= a₂₀ + a₂₁t + a₂₂t² + a₂₃t³. (4.7.18)

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

₁(0) = ₁₀, ₂(0)=₁(t_f1); (4.7.19) ₁(t)=₁₀, ₂(0)=₁(t_f1); (4.7.20)

₂(t_f2)=_2f, ₂(t_f2)=_2f; (4.7.21)

₁(0) = ₁₀, ₂(0)= ₁(t_f1); (4.7.22)

Из приведенных восьми формул могут быть найдены восемь коэффициентов a₁₀, a₁₁, a₁₂, a₁₃, a₂₀, a₂₁, a₂₂, и a₂₃ (см.домашнее задание 6)

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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



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

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

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

_i(t) =a_ni tⁿ, (4.8.1)

где a_ni - элементы матрицы размера 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 = t_m - t_m-1

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

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

с_1i(ф) = C_1j ф^j = C₁₀ + C₁₁ ф + C₁₂ ф² + C₁₃ ф³ + C₁₄ ф⁴, (4.8.3)

ф_11i(ф) = jC_1j ф^j-1 = C₁₁ + 2C₁₂ ф + 3C₁₃ ф² +4 C₁₄ ф³ , (4.8.4)

ф²_11i(ф) = j(j-1)C_1j ф^j-2 = 2C₁₂ + 6C₁₃ ф +12 C₁₄ ф². (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(ф) = C₁₄ ф⁴+ C₁₃ ф³ +^*_i0ф²₁ ф² + ^*_i0 ф₁ ф + ^*_i0. (4.8.7)

Пример 4.8.1

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

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

с_1i(ф) = C₁₄ ф⁴+ C₁₃ ф³ +^*_i0ф²₁ ф² + ^*_i0 ф₁ ф + ^*_i0 . (4.8.8)

Заметим, что в (4.8.7) имеются две неизвестные величины, которые нужно найти, -- C₁₄ и C₁₃ ; они определяются из условий непрерывности:

_1i(1) = _2i(0), _1i(1) = _2i(0), _1i(1) = _2i(0). (4.8.9)

Итак, нужно сначала вычислить _2i(ф).

Участок 2: Полином третьей степени. Используя подход, примененный для участка 1, получаем

_2i(ф) = C_2j ф^j = C₂₀ + C₂₁ ф + C₂₂ ф² + C₂₃ ф³, (4.8.10)

ф_22i(ф) = jC_2j ф^j-1 = C₂₁ + 2C₂₂ ф + 3C₂₃ ф², (4.8.11)

ф²_22i(ф) = j(j-1)C_2j ф^j-2 = 2C₂₂ + 6C₂₃ ф. (4.8.12)

Эти величины должны удовлетворять следующим условиям:

_2i(0) = ^*_i1, _2i(0) = ^*_i1, _2i(0) = ^*_i1. (4.8. 13)

Соотношения (4.8.2) и (4.8.9) определяют некоторые из неизвестных коэффициентов. Имеем

C₂₀ = ^*_i0, C₂₁ = ^*_i1 ф₂, C₂₂ =^*_i1ф²₂ , (4.8.14)

C₁₄ + C₁₃ =^*_i1 - (^*_i0 + ^*_i0 ф₁ + ^*_i0ф²₁), (4.8.15)

4ф₁^-1C₁₄ + 3ф^-1C₁₃ + ф₂^-1C₂₁ = - (^*_i0 + ф ₁^*_i0), (4.8.16)

6ф₁^-2C₁₃ + 12ф^-2C₁₄ - 2ф₂^-2C₂₂ = - ^*_i0. (4.8.17)

В конце второго участка мы, однако, должны обеспечить выполнение условий непрерывности, т. е.

_2i(1) = _3i(0), _1i(1) = _3i(0), _2i(1) = _3i(0). (4.8.18)

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

Участок 3: Полином четвертой степени. По аналогии с подходами, использованными для участков 1 и 2, имеем

_3i(ф) = C_3j ф^j = C₃₀ + C₃₁ ф + C₃₂ ф² + C₃₃ ф³ + C₃₄ ф⁴, (4.8.10)

ф_33i(ф) = jC_3j ф^j-1 = C₃₁ + 2C₃₂ ф + 3C₃₃ ф² + 4C₃₄ ф³, (4.8.11)

ф²_33i(ф) = j(j-1)C_3j ф^j-2 = 2C₃₂ + 6C₃₃ ф + 12C₃₄ф². (4.8.12)

Начальные условия имеют вид

_3i(0) = ^*_i2, _3i(0) = ^*_i2, _3i(0) = ^*_i2, (4.8.22)

которые в сочетании с формулами (4.8.8) - (4.8.10) дают

C₃₀ = ^*_i1, C₃₁ = ^*_i1 ф₃, C₃₂ = ^*_i1 ф²₃.

Соотношения непрерывности (4. 8.18) дают теперь

C₂₀ + C₂₁ + C₂₂ = ^*_i2 - ^*_i1, (4.8.24)

ф₂^-1C₂₁ + 2ф₂^-1C₂₂ + 3ф₂^-1C₂₃ - ф₃^-1C₃₁ = 0, (4.8.25) 2ф₂^-2C₂₂ + 6ф₂^-2C₂₃ - 2ф₃^-2C₃₂ = 0, (4.8.26)

Наконец, на конце участка должны выполняться ограничения:

_3i(1) = ^*_if, _3i(1) = ^*_if, _3i(1) = ^*_if, (4.8.27)

Используя соотношения (4.8.27) и (4. 8.19) -- (4.8.21), получаем

C₃₁ + C₃₂ + C₃₃ + C₃₄ = ^*_if - ^*_i2, (4.8.28)

C₃₁ + 2C₃₂ + 2C₃₃ + 4C₃₄ =^*_ifф₃, (4.8.29) 2C₃₂ + 6C₃₃ + 12C₃₄ = ^*_ifф²_3, (4.8.31)

Отметим, что, так как в общем случае ^*_i1 , ^*_i1 , ^*_i2 и ^*_i2 неизвестны, мы определили в явном виде только пять из 14 неизвестных коэффициентов, которыми являются C₁₀, C₁₁, C₁₂, C₁₃, C₁₄, C₂₀, C₂₁, C₂₂, C₂₃, C₃₀, C₃₁, C₃₃ и C₃₄. Известные коэффициенты - это

(C₁₀, C₁₁, C₁₂, C₂₀, C₃₀) ? (^*_i0, ^*_i0 ф₁, ^*_i0ф²₁,^*_i1,^*_i2).(4.8.31)

Остальные девять уравнений (4.8.15) - (4.8,17), (4.8.24) - (4.8.26) и (4.8.28) -- (4.8.30) могут быть представлены в матричной форме, а именно

 Х =

= (4.8.32)

Представляя для простоты уравнение (4.8.32) в компактной форме, получаем

ВС = д, (4.8.33)

где В -- 9Х9-матрица коэффициентов С, а д -- некоторый век- торный массив, относящийся к изменениям углов в сочленениях и их производных по времени, как показано в (4.8.32). Полное решение для С (остальные девять коэффициентов, которые нужно найти) имеет вид

С = В^-1 д (4.8.33)

Пример 4.8.2

Найти полные решения в явной форме для трех полиномов ₁(ф), ₂(ф) и ₃(ф)

Решение. Можно показать, что выражения для коэффициентов C₁₃, C₁₄, C₂₁, C₂₂, C₂₃, C₃₁, C₃₃ и C₃₄ имеют вид (см. положение А)

C₁₃ = (ф₂^-1ф₃ + 2ф₁^-1 ф₃ + 2 + 3ф₁^-1 ф₂)^-1 Ч {2 д₁^*(4 + 2 ф₂^-1ф₃ + 2ф₁^-1 ф₃ + 3ф₁^-1 ф₂) - д₂^* ф₂^-1 ф₁(3 + ф₂^-1ф₃) + 2д₁

ТРАЕКТОРИЯ ТИПА 3 -- 5 -- 3

Используя ту же процедуру, что и при выводе соотношений (4.8.41) -- (4.8.47), легко показать, что для трех участков траектории можно получить следующие выражения, описывающие движение сочленений:

- для первого участка,

-

для второго участка и

ДОПУСТИМЫЕ ТРАЕКТОРИИ ДВИЖЕНИЯ

На траектории типа 4 -- 3 -- 4 и 3 -- 5 -- 3, которые были представлены в предыдущих двух разделах в виде полиномов с_1i, с_2i и с_3i, в действительности налагаются геометрические или какие-либо другие ограничения, например недопустимость прохождения через любые недостижимые точки в пространстве обобщенных координат. Если робот, перемещающийся по траектории, сталкивается с препятствием, он может остановиться, начать потреблять значительный ток, который может сжечь плавкие предохранители, транзисторы и другие электронные компоненты. Длительное пребывание в заторможенном состоянии может закончиться серьезным повреждением в двигателях, их приводных электрических цепях и устройстве управления. Нет необходимости говорить о том, что это также может серьезно повредить или деформировать звенья робота.

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

с_imВ₁), с_imВ₂), с_imВ_k)

где В_k, k = 1, 2, …, n, - это n действительных корней производной с_im по времени ф. Так как для траектории типа 4--3--4 наивысшая степень полинома -- это четвертая степень, то отсюда следует, что имеется максимально три локальных экстремума. Здесь мы имеем дело с уравнением вида

ф ³ + б₁ ф² + б₂ ф + б₃ = 0, (4.9.1)

для которого надо найти корни. Если экстремум полинома с_i1 или с_i3 лежит вне границы допустимой области, простейшим решением будет сместить конечную точку подъема и начальную точку спуска, пока соответствующий участок целиком не будет лежать внутри рабочего пространства. Участком, доставляющим наибольшие трудности и приводящим к выходу за границы рабочего пространства, является участок с_i2. В этом случае мы должны разбить промежуточный участок траектории на два или более участков, введя дополнительные допустимые точки. Например, вычислив с_i1 -- с_i2 -- с_i3, мы вычислим затем траекторию , с^?_i2 -- с^?_i2 -- с_i3, используя условия yа конце участка с_i1.