Проектирование траектории перемещения роботов
Итак,
нужно
сначала
вычислить
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.