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

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

Рис. 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_1i t + a_2i t² + a_3i t³ , (4.7.6)

такие, что

_if = _i0 + a_1i t_f + a_2i t² _f + a_3i t³ _f , (4.7.7) 0 = a_1i , (4.7.8)

0 = 2a_2i t_f + 3a_3i t_f , (4.7.9)

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

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

a_{3 i} = 2(if- _{i 0} ) t ^-3 _f . (4.7.11)

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

_i (0) = _{i 0} , (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)

--> ЧИТАТЬ ПОЛНОСТЬЮ <--