Добавил:
Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:

Методическое пособие 659

.pdf
Скачиваний:
9
Добавлен:
30.04.2022
Размер:
3.39 Mб
Скачать

Умножим обе части уравнения (4.44) на d–1:

 

q

+Г1 q+Г0q = Г0qзад ,

(4.45)

 

 

 

 

или в подробной записи:

 

qj(t) + j1 qj(t) + j0qj(t) = j0qзадj, j = 1, 2, ..., n.

(4.46)

 

 

 

 

Эти уравнения совпадают с уравнениями (4.20) для эта-

лонных процессов q(t) qзад j, которые определяют требуемую динамику проектируемой системы.

Полученный результат позволяет сделать два заключения, имеющих практическое значение:

1. При неограниченном увеличении числовых значений

диагональных элементов jj матрицы коэффициентов усиления в алгоритме управления по ускорениям (4.32) уравнения (4.39) замкнутой системы порядка 3n переходят в n независимых уравнений (4.46) второго порядка, определяющих

эталонные процессы q(t) qзадj по каждой степени подвижности. Следовательно, алгоритм управления по ускорению

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

qj(t) qзадj к эталонным q(t) qзадj достигается при конечных значениях jj.

2. Контуры управления по ускорению по каждой степени подвижности можно строить независимо один от другого в соответствии с уравнениями (4.31) или в интегральной форме (4.33). Назначенные динамические свойства проектируемой

системы достигаются при диагональной матрице = diag{ jj} в алгоритме (4.32) или (4.34).

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

(Tэj 0). В результате можно показать, что при неограничен-

90

ном увеличении диагональных элементов kjj матрицы k=diag{kjj} в алгоритме (4.24) процессы в замкнутой системе будут описываться n независимыми уравнениями второго по-

рядка по каждой степени подвижности. Причем при kjj

справедливо qj(t) qjэ (t).

Для полной модели (Tэj 0) контуры управления ускорениями также следует формировать независимо по каждой

управляемой координате. Требуемые ускорения jэ и управляющие напряжения Uj определяются из уравнений системы

(4.28).

Применение алгоритма управления по ускорению связано с необходимостью расчета 3n параметров. Из них 2n пара-

метров – коэффициенты j1 и j0 усиления внешних контуров и n параметров – коэффициенты jj усиления контуров уско-

рения. Расчет j1 и j0 выполняется по формулам (4.22) в соответствии с заданным качеством переходных процессов. Получим выражение для определения числовых значений пара-

метров jj.

Запишем уравнения замкнутой системы в следующем

виде:

 

 

 

 

 

 

 

 

 

А(q)q

+ В

(q,q)q + C(q) = N[eU c q ],

 

 

~

 

~

 

 

 

 

 

 

 

 

U (t) = (Еэ q ),

(4.47)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

где В

(q,q)q

= B(q,q ).

 

 

~

 

 

 

 

 

 

 

Далее нам потребуются уравнения, записанные в координатной форме:

 

 

Аj (q)

q

+

Вj (q,q) q + Cj(q) = nj(ejjUj

cjj qj),

 

 

~

 

 

~

 

 

 

 

 

 

 

 

 

U j (t) = jj({ jэ qj),

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

~

~

 

 

 

– строки с номером j

матриц

где Аj (q),Вj (q,q)

~

 

 

 

 

 

 

 

 

В(q,q);

 

 

 

 

 

 

 

Cj(q) – элемент с номером j вектора C(q).

(4.48)

~

А(q) и

91

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

для U j из второго уравнения, получим следующее выражение:

~

 

 

 

 

 

 

 

 

 

 

Аj j (q) j + [ jj(q,q ) + nj(ejj jj + cjj)] j =

 

 

= njejj jj jэ + j(q,

 

 

 

(4.49)

где j = qj.

q , ...),

 

 

 

 

 

 

 

 

 

 

 

 

 

В уравнении (4.49) принято следующее обозначение:

 

 

n

~

 

 

n

~

 

 

 

jj(q,q) = B(q,q ) + Аj j (q)/ qi + ( Вj j (q,q)/ qs )qs.(4.50)

При этом

~

i 1

и

~

 

s 1

 

 

 

 

Аj j (q)

Вj j (q,q)

есть диагональные элемен-

~

 

~

 

 

 

 

 

 

 

 

ты матриц А(q) и В (q,q ). Функция j(q,

q , ...) включает все

компоненты, которые выступают в роли внешних воздействий для контура ускорения.

 

Преобразуем (4.49) к следующему виду:

 

 

 

 

 

 

~

 

 

 

 

 

 

 

n

e

 

 

 

 

 

 

 

 

 

 

А

j j

(q)

j

 

 

 

 

jэ

j

(q,q,...)

 

 

 

 

 

 

 

j

 

j

 

jj jj

 

 

 

 

.(4.51)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

j j (q,q)+nj (ejj jj +cjj )

 

 

j j (q,q)+nj (ejj jj +cjj )

 

 

Динамика контура ускорения определяется постоянной

времени

 

 

 

 

 

 

 

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Т j

 

 

Аj j (q)

 

 

 

 

.

 

(4.52)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

j j (q,q)+nj (ejj jj +cjj )

 

 

 

 

 

Подставляя выражения для ejj и cjj

из (4.7) в (4.52), по-

лучим следующее уравнение:

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Т j

 

 

Rj Аj j (q)

 

 

 

 

 

.

(4.53)

 

 

 

 

 

 

 

 

 

 

 

 

+kejnj )

 

 

 

 

 

 

Rj j j (q,q)+njkmj ( jj

 

 

Формула (4.53) получена с учетом взаимного влияния степеней подвижности. Если это влияние не учитывать

92

( jj(q,q) = 0), то постоянные времени контуров ускорения вычисляются по формулам

~

 

 

 

Rj Аj j (q)

 

 

 

Т j njkmj ( jj +kejnj )

,

j = 1, 2, ..., n.

(4.54)

Числовые значения jj определяются из условия, что максимальная постоянная времени контура ускорения на порядок меньше Tj :

 

 

 

~

 

 

 

 

maxТ

 

 

Rjmax[Аj j (q)]

(0,1 0,2)Т

 

. (4.55)

j

njkmj ( jj +kejnj )

j

 

 

 

 

 

Из (4.55) определяем коэффициент усиления контура

ускорения

 

 

~

 

 

 

 

 

 

 

 

 

 

 

jj (5 10)

Rjmax[ Аjj(q)]

kejnj .

 

(4.56)

Т jnjkmj

 

 

 

 

 

 

 

 

Возможность определения коэффициентов усиления jj по упрощенному выражению (4.56) обусловлена тем, что системы, управляемые по ускорению, малочувствительны к параметрическим и координатным возмущениям.

На основании вышесказанного порядок расчета параметров алгоритмов управления следующий.

1. Определить для заданных параметров манипуляционной системы с учетом инерционно-массовых характеристик наименьшую достижимую длительность tj переходного про-

цесса qj(t) qзадj, причем tj > 3Tmj, где Tmj определяется из выражения (4.23).

2. Вычислить по формулам (4.22) коэффициенты j1 иj0 усиления внешних контуров.

3. Найти наибольшие значения диагональных элементов

~ ~

Аj j (q) матрицы А(q) и по формуле (4.56) вычислить коэф-

фициенты усиления jj контуров ускорений.

93

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

4.4.Позиционное управление манипулятором

вдекартовой системе координат

Уравнения движения рассматриваемого трехкоординатного манипулятора имеют вид (1.15), при этом с учетом (4.9), (4.14) и (4.20) получим

 

А1 x1= n1h1[U1km1/R1 – (km1ke1n1/R1h1) х

1],

 

 

 

 

 

 

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

А2

x2= n2h2[U2km2/R2

(km2ke2n2

/R2h2) х

2],

 

(4.57)

 

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

~

 

C3h3

2

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

А3

x3 +

 

 

 

= n3h3[U3km3/R3 – (km3ke3n3/R3h3) х3],

 

 

~

 

2

 

 

 

 

 

 

2

~

 

2

 

 

 

 

 

 

 

 

2

~

 

 

 

2

 

 

 

 

2

 

 

+ J 1n1

 

+ J

 

2n2

3 = A3h3

+ J

3n3

.

где А1= A1h1

 

 

, А2= A2h2

 

 

 

, А

 

 

 

Введем следующие обозначения:

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

~

 

 

 

 

 

1n1

2

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

В 1(х1) = (km1ke

 

 

/R1) х1,

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

~

 

 

 

= (km2ke2n2

2

/R2)

 

 

 

 

 

 

 

(4.58)

 

 

 

 

 

 

 

В 2(

х2)

 

х 2,

 

 

 

 

 

 

 

 

 

 

 

~

 

 

3)=(km3ke3n3

2

/R3)

 

+C3h3

2

.

 

 

 

 

 

 

 

 

 

 

 

В 3(

х

 

 

х3

 

 

 

 

 

 

 

 

С учетом принятых обозначений управляемый процесс

описывается следующей системой уравнений:

 

 

 

 

 

 

 

 

 

 

 

 

 

~

 

 

 

+

~

 

 

 

 

 

 

 

 

 

 

 

/R1)U1,

 

 

 

 

 

 

 

 

 

 

 

 

 

А

1 x1

В 1(х1) = (n1h1km1

 

 

 

 

 

 

 

 

 

 

 

 

~

 

 

 

+

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

(4.59)

 

 

 

А2 x2

В 2

( х2) = (n2h2km2/R2)U2,

 

 

 

 

 

 

 

 

 

~

 

 

 

+

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

А3 x3

В 3

( х3) = (n3h3km3/R3)U3.

 

 

 

 

 

 

 

 

 

Задачу синтеза алгоритма позиционного управления сформулируем следующим образом.

94

Синтезируемый алгоритм управления должен обеспечивать перевод механизма из начального состояния

x1(0), х1(0),

x2(0), х2(0),

x3(0), х3(0)

(4.60)

 

 

 

 

в назначенное состояние, которое соответствует неподвижной точке (xзад1, xзад2, xзад3)т. Необходимо при этом, чтобы переход-

ные процессы xj(t) xзад j (t), j = 1, 2, 3

являлись решениями

уравнений

 

 

 

 

хjэ(t) + j1

хj(t) + j0хj(t)

= j0хзад j.

(4.61)

 

 

 

 

 

Решение поставленной задачи достигается с помощью

алгоритмов управления по ускорению

 

(4.62)

U j = j (aj

хj).

 

 

 

 

 

 

 

 

 

 

Требуемые ускорения вычисляются из (4.61) по формуле

aj = хjэ

= j0(хзад j xj)

j1 х j.

(4.63)

 

 

 

 

 

Уравнения (4.62) можно записать в интегральной форме

 

t

 

 

(4.64)

Uj(t) = j ( aj dt хj).

 

 

 

 

 

0

Структурная схема одного из каналов системы управления трехкоординатным манипулятором, соответствующая (4.63) и (4.64), приведена на рис. 4.6. Два других канала системы управления имеют идентичную структуру. Коэффици-

енты j0 и

j1

определяются

из

уравнения

(4.22) при

j = 1, 2, 3.

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

xзадj

 

 

 

aj

 

 

 

 

 

 

 

Uj

 

 

 

xj

γjo

 

 

 

 

 

 

αj

 

ИМ

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

xj

 

 

 

 

 

 

 

 

 

 

 

 

 

 

xj

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

γj1

 

xj

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Рис. 4.6. Структурная схема канала системы управления манипулятором, работающего в декартовой системе координат

95

Система независимых уравнений (4.59) с учетом (4.62), (4.63) при неограниченном возрастании j преобразуется в три уравнения, совпадающие с соответствующими уравнениями (4.61). Требуемая степень приближения управляемых процессов к эталонным может быть достигнута при конечных значениях коэффициентов усиления j.

Постоянные времени контуров ускорения вычисляются в соответствии с (4.54) по формулам

~

Та j Rj Аj , j = 1, 2, ..., n. (4.65)

njkmj ( jjhj +kejnj )

Коэффициенты усиления j определяются из уравнения

~

 

 

Rj Аj

 

 

Та j njkmj ( jhj +kejnj )

(0,1 0,2)Т j .

(4.66)

Из (4.66) следует расчетная формула для определения

коэффициентов усиления контуров ускорения

~

j (5 10) Rj Аj kejnj . (4.67)

Тjnjkmjhj hj

4.5.Позиционное управление манипулятором

вцилиндрической системе координат

Уравнения динамики рассматриваемого трехкоординатного манипулятора получены в разделе 1.3 в виде (1.29). С учетом (4.12), (4.18) запишем их следующим образом:

A

(r) B (r,r, )= n

1[U

1km1

/R1 – (km1ke1n1/R1) ],

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

~

 

2

=n2h2[U2km2

/R2

 

 

 

 

 

 

 

(4.68)

Al l

Clh2

– (km2ke2n2 /R2h2) l ],

 

~

 

 

2

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Arr Br (r, )h3 =n3h3

[U3km3 /R3 –(km3ke3n3 /R3h3) r ],

 

~

 

 

 

 

2

,

~

2

 

 

2

,

~

2

 

 

2

 

 

 

 

 

 

 

 

где A (r) A (r) J 1n1

 

Al

Alh2 J 2n2

 

Ar Arh

3

J 3n3 .

96

 

Приведем систему (4.68) к виду

 

 

= (n1km1/R1)U1,

A (r) B

(r,r, )+ (km1ke1n1

2

/R

1)

 

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

~

 

 

2

+ (km2ke2n

2

2

 

 

 

 

 

 

= (n2h2km2/R2)U2, (4.69)

~

Al l Clh2

 

/R2) l

 

 

 

 

2

 

 

 

 

 

 

2

 

 

 

 

 

 

 

 

 

 

 

/R3)U3.

Arr

Br (r, )h3 + (km3ke3n3

 

/R3) r = (n3h3km3

 

Введем следующие обозначения:

 

 

 

 

 

 

 

 

B

(r,r, ) B

(r,r, ) (km1ke1n1 /R1) ,

 

 

 

 

~

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

2

 

 

 

 

 

 

~

 

 

h

2

(k

 

 

k

 

n

2

/R

 

 

(4.70)

 

 

 

 

 

B (l) C

2

m2

e2

2

2

) l ,

 

 

 

 

~

l

 

l

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

2

 

 

 

 

 

 

 

2

 

 

 

 

 

Br (r,r, ) Br (r, )h3

(km3ke3n3/R3)r .

С учетом принятых обозначений (4.70) уравнения (4.69) запишутся в виде

A (r) B (r,r, )= n1U1km1/R1,

~

 

~

 

 

~

 

 

~

 

/R2,

(4.71)

 

A

l

l

+B

(l) = n2h2U2km2

~

 

 

l

 

 

 

 

 

 

~

 

 

 

Arr

 

+Br (r,r, ) = n3h3U3km3/R3.

 

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

Задача синтеза алгоритма позиционного управления рассматриваемым трехкоординатным манипулятором формулируется следующим образом.

В начальный момент времени t = 0 состояние управляемого исполнительного механизма характеризуется некоторыми значениями координат и скоростей их изменения

(0), (0), l(0),

l

(0), r(0),

r (0).

(4.72)

 

 

 

 

 

 

 

 

Требуется синтезировать такие алгоритмы вычисления управляющих напряжений Uj, при которых исполнительный механизм переходит из начального состояния (4.72) в окрест-

ность заданной точки с координатами зад, lзад, rзад и продол-

97

жает оставаться в этой окрестности бесконечно долго. Необ-

ходимо при этом, чтобы процессы (t) зад, l(t) lзад, r(t) rзад являлись решениями дифференциальных уравнений:

 

 

 

э(t)

+ 1 (t)

+ 0 (t) = 0 зад,

 

 

 

 

 

 

 

 

 

 

 

 

 

l э(t) + l1 l (t)

+ l0 l(t) =

l0lзад,

(4.73)

 

 

 

r э(t) + r1 r (t)

+ r0 r(t) =

r0rзад,

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

где

l э

(t),

– эталонные ускорения по координа-

э(t),

r э(t)

там;

1, 0, l1, l0, r1, r0

– параметры алгоритма управления.

 

 

Выполнение равенств (4.73) достигается в том случае,

когда в процессе движения ускорения управляемых координат

равны

 

 

,

( , ) = э = 0( зад – ) – 1

 

 

 

 

al(l,l ) = l э

= l0(lзад l) – l1 l ,

(4.74)

ar(r,r ) = r

э = r0(rзад r) – r1 r .

 

 

 

 

Фактические ускорения , l , r отличаются от соответ-

ствующих эталонных э, l э, r э. Чтобы синтезировать алго-

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

U

1

= ( – ),

U

2 = l(al l

),

U

3 = r(ar r ), (4.75)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

где , l, r = const > 0.

 

 

 

 

 

 

В результате интегрирования получаем уравнения:

 

 

t

 

– (t)], U2(t)

 

t

(t)],

 

 

U1(t) = [ dt

= l[ al dt l

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

0

 

 

 

 

0

(4.76)

 

 

 

 

t

 

r (t)].

 

 

 

U3(t) = r[ ar dt

 

 

 

 

 

 

 

 

 

 

 

 

 

 

0

 

 

 

 

98

На основе уравнений (4.74) и (4.76) получена структурная схема, представленная на рис. 4.7.

γ 1

зад

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

U1

 

 

 

 

 

 

 

 

 

 

γ o

 

 

 

 

 

 

 

 

 

 

 

α

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

lзад

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

U2

ИМ

 

l

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

rзад

 

 

 

 

 

 

 

 

 

 

 

ar

 

 

 

 

 

 

 

U3

 

 

 

r

 

 

 

 

 

 

γro

 

 

 

 

 

 

αr

 

 

 

r

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

r

 

r

 

 

 

 

 

 

 

 

 

 

 

 

 

γr1

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Рис. 4.7. Структурная схема системы управления трехкоординатным манипулятором, работающим в цилиндрической системе координат

На схеме детально представлены два канала по координатам и r. Система содержит три внутренних контура отработки ускорений. В структуру этих контуров входит исполнительный механизм ИМ, каждая степень подвижности которого является составной частью соответствующего контура. Требу-

емые ускорения , al и ar формируются внешними контурами по информации о состоянии управляемого процесса (коорди-

наты , l, r и их производные ,l ,r ). Если линейные коорди-

наты l и r и их производные l и r недоступны физическому измерению, они могут быть вычислены по соотношениям:

l = 2h2,

r = 3h3,

l

=

2h2,

r

=

3h3, (4.77)

 

 

 

 

 

 

 

 

 

 

 

 

 

где 2, 3 – углы поворота валов редукторов в степенях подвижности;

99