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

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

loading="lazy" src="http://xreferat.ru/image/76/1307123526_17.gif" alt="Проектирование траектории перемещения роботов" width="24" height="47" align="BOTTOM" border="0" />2i(0). (4.8.9)


Итак, нужно сначала вычислить Проектирование траектории перемещения роботов2i(τ).

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


Проектирование траектории перемещения роботов2i(τ) = Проектирование траектории перемещения роботовC2j τj = C20 + C21 τ + C22 τ2 + C23 τ3, (4.8.10)

τ2Проектирование траектории перемещения роботов2i(τ) = Проектирование траектории перемещения роботовjC2j τj-1 = C21 + 2C22 τ + 3C23 τ2, (4.8.11)

τ22Проектирование траектории перемещения роботов2i(τ) = Проектирование траектории перемещения роботовj(j-1)C2j τj-2 = 2C22 + 6C23 τ. (4.8.12)


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


Проектирование траектории перемещения роботов2i(0) = Проектирование траектории перемещения роботов*i1, Проектирование траектории перемещения роботов2i(0) = Проектирование траектории перемещения роботов*i1, Проектирование траектории перемещения роботов2i(0) = Проектирование траектории перемещения роботов*i1. (4.8. 13)


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


C20 = Проектирование траектории перемещения роботов*i0, C21 = Проектирование траектории перемещения роботов*i1 τ2, C22 =Проектирование траектории перемещения роботовПроектирование траектории перемещения роботов*i1τ22 , (4.8.14)

C14 + C13 =Проектирование траектории перемещения роботов*i1 - (Проектирование траектории перемещения роботов*i0 + Проектирование траектории перемещения роботов*i0 τ1 + Проектирование траектории перемещения роботовПроектирование траектории перемещения роботов*i0τ21), (4.8.15)

4τ1-1C14 + 3τ-1C13 + τ2-1C21 = - (Проектирование траектории перемещения роботов*i0 + τ 1Проектирование траектории перемещения роботов*i0), (4.8.16)

6τ1-2C13 + 12τ-2C14 - 2τ2-2C22 = - Проектирование траектории перемещения роботов*i0. (4.8.17)

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


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


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

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


Проектирование траектории перемещения роботов3i(τ) = Проектирование траектории перемещения роботовC3j τj = C30 + C31 τ + C32 τ2 + C33 τ3 + C34 τ4, (4.8.10)

τ3Проектирование траектории перемещения роботов3i(τ) = Проектирование траектории перемещения роботовjC3j τj-1 = C31 + 2C32 τ + 3C33 τ2 + 4C34 τ3, (4.8.11)

τ23Проектирование траектории перемещения роботов3i(τ) = Проектирование траектории перемещения роботовj(j-1)C3j τj-2 = 2C32 + 6C33 τ + 12C34τ2. (4.8.12)


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


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


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


C30 = Проектирование траектории перемещения роботов*i1, C31 = Проектирование траектории перемещения роботов*i1 τ3, C32 =Проектирование траектории перемещения роботов Проектирование траектории перемещения роботов*i1 τ23.


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

C20 + C21 + C22 = Проектирование траектории перемещения роботов*i2 - Проектирование траектории перемещения роботов*i1, (4.8.24)

τ2-1C21 + 2τ2-1C22 + 3τ2-1C23 - τ3-1C31 = 0, (4.8.25) 2τ2-2C22 + 6τ2-2C23 - 2τ3-2C32 = 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), получаем


C31 + C32 + C33 + C34 = Проектирование траектории перемещения роботов*if - Проектирование траектории перемещения роботов*i2, (4.8.28)

C31 + 2C32 + 2C33 + 4C34 =Проектирование траектории перемещения роботов*ifτ3, (4.8.29) 2C32 + 6C33 + 12C34 = Проектирование траектории перемещения роботов*ifτ23, (4.8.31)


Отметим, что, так как в общем случае Проектирование траектории перемещения роботов*i1 , Проектирование траектории перемещения роботов*i1 , Проектирование траектории перемещения роботов*i2 и Проектирование траектории перемещения роботов*i2 неизвестны, мы определили в явном виде только пять из 14 неизвестных коэффициентов, которыми являются C10, C11, C12, C13, C14, C20, C21, C22, C23, C30, C31, C33 и C34. Известные коэффициенты – это


(C10, C11, C12, C20, C30) ≡ (Проектирование траектории перемещения роботов*i0, Проектирование траектории перемещения роботов*i0 τ1, Проектирование траектории перемещения роботовПроектирование траектории перемещения роботов*i0τ21,Проектирование траектории перемещения роботов*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

Найти полные решения в явной форме для трех полиномов Проектирование траектории перемещения роботов1(τ), Проектирование траектории перемещения роботов2(τ) и Проектирование траектории перемещения роботов3(τ)

Решение. Можно показать, что выражения для коэффициентов C13, C14, C21, C22, C23, C31, C33 и C34 имеют вид (см. положение А)


C13 = (τ2-1τ3 + 2τ1-1 τ3 + 2 + 3τ1-1 τ2)-1 Ч {2 δ1*(4 + 2 τ2-1τ3 + 2τ1-1 τ3 + 3τ1-1 τ2) – δ2* τ2-1 τ1(3 + τ2-1τ3) + 2δ1


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


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


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


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


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


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


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


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


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


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

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


ρimВ1), ρimВ2), ρimВk)


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


τ 3 + α1 τ2 + α2 τ + α3 = 0, (4.9.1)


для которого надо найти корни. Если экстремум полинома ρi1 или ρi3 лежит вне границы допустимой области, простейшим решением будет сместить конечную точку подъема и начальную точку спуска, пока соответствующий участок целиком не будет лежать внутри рабочего пространства. Участком, доставляющим наибольшие трудности и приводящим к выходу за границы рабочего пространства, является участок ρi2. В этом случае мы должны разбить промежуточный участок траектории на два или более участков, введя дополнительные допустимые точки. Например, вычислив ρi1 — ρi2 — ρi3, мы вычислим затем траекторию , ρ′i2 — ρ″i2 — ρi3, используя условия yа конце участка ρi1.

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

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

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

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