Устройство для управления электроприводом робота

 

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

СОЮЗ СОВЕТСКИХ

СОЦИАЛИСТИЧЕСКИХ

РЕСПУБЛИК (я)5 В 25 J 13/00

ГОСУДАРСТВЕННЫЙ КОМИТЕТ

ПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМ

ПРИ ГКНТ СССР

ОПИСАНИЕ ИЗОБРЕТЕНИЯ

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4692358/08 . (22) 22.05,89 (46) 23.07,91. Бюл. М 27 (71) Дальневосточный политехнический институт им. В. В, Куйбышева (72) В. С. Очкал и В. Ф. Филаретов (53) 621.229.72(088.8) (56) Авторское свидетельство. СССР

1Ф 1553376 кл, В 25 3 13/00, 1988, (54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ

ЭЛЕКТРОПРИВОДОМ РОБОТА (57) Изобретение относится к робототехнике и может быть использовано при создании

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

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

2, первый релейный элемент 3, второй блок

4 умножения, усилитель 5 мощности, электродвигатель 6, датчик 7 скорости, редуктор

8, объект 9 управления, датчик 10 положения, второй сумматор 11, первый выпрямитель 12, датчик 13 тока, второй релейный элемент 14, третий сумматор 15, задатчик 16 сигнала, четвертый сумматор 17, первый функциональный преобразователь 18, третий релейный элемент 19, блок 20 выборки и запоминания, датчик 21 ускорения, второй выпрямитель 22, блок 23 деления, пятый сумматор 24, второй функциональный преобразователь 25, шестой сумматор 26, пер.Ы2,„, 1664548 А1 электроприводов роботов с переменными нагрузочными параметрами. Целью изобретения является улучшение динамических характеристик эа счет компенсации влияния электрической постоянной времени электродвигателя. Для этого в устройство введены пятый и шестой блоки умножения, десятый и одиннадцатый сумматоры и второй квадратор, которые обеспечивают адаптивную настройку положения поверхности скольжения с учетом величины суммарного момента инерции и постоянной времени электродвигателя. 1 ил. вый квадратор 27, третий блок 28 умножения, третий выпрямитель 29, седьмой сум матор 30, четвертый блок 31 умножения, восьмой сумматор 32, девятый сумматор 33, четвертый выпрямитель 34, десятый сумматор 35, пятый блок 36 умножения квадратор

37, одиннадцатый сумматор 38,.шестой блок

39 умножения.

Устройство для управления электроприводом робота работает следующим образом.

В исходном состоянии на выходах датчиков 7, 21 и 13 угловой скорости, углового ускорения и тока электродвигателя 5 сигналы равны нулю. На выходе датчика 10 углового положения сигнал соответствует фактическому угловому положению выходного вала редуктора 8, При этих условиях на инвертирующем входе сумматора 24 и на втором положительном входе сумматора 38

- сигнал также равен нулю. На выходе задатчика 16 сигнала установлен положительный уровень сигнала, значение которого будет определено ниже. Функциональный преобразователь 25 реализует вычисления по

1664548 формуле у = Vx Поэтому.с выходу сумматора 26 на первый вход блока 39 умножения и через квадратор 37 на вход блока 1 умножения поступают положительные сигналы, обозначенные соответственно, Cz и С1, Сигнал S на входе релейного элемента

3 равен

S = Ез+ CzEz+ С1Е1 (1) где Е1 = (g — а)-сигналрассогласования (ошибки) системы по угловому положению, устанавливающийся на выходе сумматора 2;

Ez = (g Кр1 — сигнал рассогласования системы по скорости на выходе сумматора 30;

Ез = (g Kp) — сигнал рассогласования системы по угловому ускорению на выходе сумматора 35;

Кр — коэффициент передачи редуктора

В исходном состоянии программные задающие сигналы g, g, 9, g, соответственно равны нулю.

Как отмечено выше, на выходе блока 20 в исходном положении сигнал равен нулю, а следовательно, и на выходах выпрямителей 29 и 34 сигналы также равны нулю.

В результате на электродвигатель 6 в исходном состоянии напряжение не подается.

Динамика нескорректированного электропривода постоянного ТоКВ с учетом электрической постоянной времени элект. родвигателя может быть описана (в силу введенных выше обозначений) следующей системой дифференциальных уравнений:

g> =Е2

Ez= Ез

E3= 8z Ez-азЕз+ М+ G - Ь и

"д (к. .а,) «в г= а,= —,+

1. к к

b = a> G =j ° acijia ji K =аааа

М kð мМ* = R (Метр + Мвн), () — символ дифференцирования по времени.

В системе (2) также использованы следующие обозначения: R, L — соответственно активное и индуктивное сопротивление якорной цепи электродвигателя 6; K — коэффициент крутящего момента; К вЂ” коэффициент противо-ЭДС; К вЂ” коэффициент вязкого трения; Ky — коэффициент передачи усилителя 5 мощности, M>< — внешний нагрузочный момент, Mgyp — момент сухого трения, — суммарный момент инерции ротора двигателя и вращающихся частей кинематической передачи; U — управляющий сигнал; g, g, я, 9 — программные значения углового положения, угловой скорости, углового ускорения и ее производной вращения выходного вала редуктора 8, подаваемые на соответствующие входы устройства, Полага10 ем, что I<, может дискретно принимать любые значения из диапазона. 4 0 мин, макс) в начале каждого рабочего цикла, Это имеет место во многих электроприводах манипуляционных систем.

Для возникновения и существования скользящего режима работы необходимо соблюдение условия:

S S 0, (3) где уравнение Я= Ез+ С2Ег + С1Е1 = 0 эастранстве фазовых координат Е1, 20

Ez, Ез гиперплоскость переключения, Cq>0 и С >0 — некоторые коэффициенты.

Для выполнения (3) 0 сформулируем в виде:

0=(,lf,/i k,/ì /+ к,/c/) 5

25 у

Несложно показать, что с учетом (4), (2) можно получить а =I((ac,— а, -а а,а,1е,) аа-cci c, Е,— - (,/ 8,Б)+(м-Ь k.,/м /5 „5 J

- (С, — b к / С,/ 5 „ 1 .

Очевидно, что для удовлетворения (3) должны выполняться следующие соотношения:

40 (7) 45

b =/C0 -С,j С,/, а (6)

С Сz oyсz+оj р

k,» (8) 2 р м (9)

Выражения (6) и (7) получают из первых двух слагаемых в квадратных скобках выра50 жения (5). Неравенство (8) получено из третьего слагаемого в (5) с учетом выраже- а ний для B, M, М, а неравенство (9) вытекает из последнего слагаемого (5) с учетом выражения G. Очевидно, что при Iz = Var (изме55 няющегося от одного рабочего цикла к другому) соотношение (7) без введения специальных средств подстройки коэффициентов С1 и Cz в зависимости от текущего значения Iz нарушается, В результате при использовании управления вида (4) тради1664548

10

K макс .!

15 (1 5) вид: (3 ) =-Iaг (3 1 (. ), ционный подход формирования систем с переменной структурой не позволяет сохранить устойчивый, скользящий режим работы. В данном случае требуется вводить самонастройку С1и Cz для неизменного выполнения уравнения (7) при любых текущих значениях lg и с учетом электрической постоянной времени электродвигателя.

Для устойчивого движения по гиперплоскости S=O прежде всего необходимо, чтобы С1 > Ои Cz >О. В этом случае за счет выбора С1 и С с учетом(7)удается добиться и монотонного убывания переходного процесса по закону

B,(t-I =A E, A e", (10) г где А1 и Az — некоторые постоянные интегрирования, зависящие от начальных условий;

Л1 и А2 — корни характеристического уравнения S=O, Абсолютная величина А и

А2 и определяет скорость убывания Е .

В результате задача повышения быстродействия и точности системы сводится к выбору таких значений С> и Cz удовлетворяющих (7), при которых обеспечивается монотонный характер переходных процессов и максимальная скорость затухания (10). Очевидно, что неравенства (8) и (9) не сказываются на выборе С1 и Cz, а следовательно, и на.быстродействие скользящего режима работы.

Для получения максимальной скорости затухания(но без перерегулирования) Е> должно выполняться условие:

2 (11)

В этом случае выражение (10) примет

Я ((д д .j. < (/2) С (12) т. е. скорость затухания Е> будет пропорциональна величине Cz. увеличиваясь с ростом

С2.

Из уравнения (7) с учетом (11) имеем

С О с +аг — - О, (13)

Непосредственно из (13) можно определять максимально возможное значение

С2() (14) при котором согласно (12) будет иметь место максимальная скорость затухания Е1.

Как было отмечено, для устойчивого возникновения и существования скользящего режима необходимо, чтобы одновременно с уравнением (7) удовлетворялись и

55 другие соотношения — (6), (8) и (9). Выполнение условия (6) для всего диапазона изменения Cz (1 ) при 1 1 (чин,Paкс) не трудно обеспечить эа счет выбора соответствующего значения коэффициента Ку передачи усилителя 5 мощности системы, поскольку с учетом (2), (11), (14) условие (6) можно переписать в виде;

) 3

По соотношению (15), имея паспортные данные конкретного электродвигателя, не сложно определить требуемое значение Ку, которое бы для любого I>. - ((ìèí,1акс) удовлетворяло условию (6). По выбранному таким образом Ку легко определить и требуемое значения коэффициентов Кт и Kz, удовлетворяющие условиям (8) и (9).

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

Устройство работает следующим образом.

При включении последнего и подачи на его входы программных задающих воздействий 9, 9, 9 и g на выходах соответствующих измерителей рассогласования выявляются сигналы ошибок Е, Е2, Ез,В результате на выходе второго блока 4 умножения появитсясигнал 0= (IE> I+K) 1М*1 + Kz l G I ) SgnS, подаваемый на вход усилителя 5 мощности.

На вход электродвигателя 6 с усилителя 5 мощности поступает напряжение и =кч (/е,/ к /м (+к2(с/5я 5 " (16) при этом выходной вал электродвигателя 6 начинает вращаться в направлении, соответствующем уменьшению ошибки системы по угловому положению Е . Будем считать, что нагрузочный момент Ми, приведенный к валу электродвигателя 6, складывается иэ

I моментов сухого трения Мстр=Мт Sgn Og, вязкого трения Мв= Кц.а и Мви — внешнего нагрузочного момента, т. е.

Мн=М стр+Мв+Мвн (17) 1664548 где Мт — коэффициент; пропорциональный моменту сухого трения.

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

Для электродвигателя 6 постоянного тока справедливо соотношение: (4 ин У (18)

< где ag, iig — угловая скорость и ускорение вращения вала электродвигателя 6;

M « — величина динамического момента; ! — якорный ток двигателя. Из (18) следует, что

-l ф

M 98È (19)

Соотношение (19) используется для оценки

-1 текущего значения величины I

Коэффициент усиления датчика 13 тока совместно с коэффициентом усиления по входу сумматора 17 устанавливается равным К:м коэффициент усиленйгя по инвертирующему входу сумматора 15 устанавливается равным

Кэ, по его инвертирующему входу — равным 1.

Если при этом коэффициент усиления по первому входу сумматора 32 равен Мт, а по второму входу — Ms (константе, равной максимально возможной по техническим условиям величине внешнего нагрузочного момента, и при этом второй релейный элемент с нулевой нейтральной точкой 14 реализует функцию Sg, то на выходе сумматора

17 формируется сигнал (Куд I-MH), соответствующий знаменателю (19). Уровень выходйого сигнала задатчика 16 сигнала устанавливается равным 1 (например, 1B).

Первый функциональный преобразователь 18 реализует функцию

/М „„/ прй /М и„! > Ь

F) )-при /М „„/4 d ) (20) где Ь- малая положительная константа.

При 1 Мд« I > Ь в блоке 23 деления вычисляется отношение модулей величин

lt —.1

ag и Мдя>, т. е. определяется значение f<

П ри малых значениях I Ìä«I Л в блоке 23 осуществляется деление на А . Этим устраняется ситуация деление на ноль.

Третий релейный элемент 19 реализует функцию

4 np /М „„/ Ь г

0 при /М „„ f «

При сигнале "1" на выходе релейного элемента 19 блок 20 выборки-хранения передает с единичным коэффициентом сигнал с выхода блока 23 деления на инвертирующий вход сумматора 24, при сигнале Ег-0 на выходе блока 20 хранится уровень сигнала, имевший место в момент переключения элемента 19.

Таким образом, нэ выходе блок 20 выборки и хранения при значениях модуля

1 Мин! > 0 будет сигнал, равный текущему

1й, прн 1Мкнк! < гк-1к ттн) . где tn-ìîìåíò времени, при котором величина модуля

1Мдин входит в область (-h,дЬ).

В процессе движения электропривода при некоторой комбинации значений Е1, Ег, Ез происходит смена знака сигнала S, вызывающая переключение релейного элемента 3.

Согласно (4), сигнал 0 на выходе усилителя 5 мощности сменит знак, скорость ая и ускорение ая уменьшатся, и снова сигнал

$ сменит знак, релейный элемент 3 переключится и т. д. В результате возникает скользящий режим. Для обеспечения устойчивого скользящего режима, протекающего с максимально возможной скоростью для текущего значения !" (!удин,! а с) как и было указано выше, С1 и Сг должны быть связаны соотношениями (6), (7) и (1 1), Следовательно, величину коэффициента Сг (f ) необходимо определять из уравнения (14) с учетом выражения (2).

Коэффициент передачи по инвертирующему входу сумматора 24, подключенного к выходу блока 20 выборки и хранения, на4 . — 1 страиваются равным ((Кр К +Я К,).1 по

40 входу — равным 1. Коэффициенты передачи по положительным входам сумматора 38 настраиваются соответственно равным — — и

2R

3 L г K> . Таким образом, на входе первого квад2

45 ратора 27 формируется сигнал — (+ — ) Ко2 R Кв-д ! г эффициенты передачи по входам сумматора

26 равны 1. С учетом этого на выходе по50 следнего сигнал равен Сг (соответствует выражению (14)). Второй квадратор 37 реализует формулу (11). Параметр Ку выбирается по выражению (15) нэ основании конкретных паспортных данных электродвигателя 6 и

55 редуктора 8 так, чтобы п оследнее удовлетВорялось при любых fzC(fq «! макс)

Необходимо отметить, что в практических задачах выполняется условие

y(g+ 7Q() одетому подко4 R Кв 4 КмКщ+ЯКв

1664548

10 ренное выражение в (14) больше нуля, и операция извлечения корня в функциональном преобразователе 25 выполняется корректно. Отметим также, что настройка задатчика

16 сигнала и коэффициентов передачи по входу сумматора 38 и входу сумматора 32 может быть другой, важно лишь оставить тем же произведение уровня его сигнала на соответствующий коэффициент передачи. Коэффициенты передачи по входам пятого блока 36

5 умножения, по входу шестого блока 39 умножения, по входу сумматора 11, по входам сумматора 33, по входу третье-о блока 28 умножения равны 1.

Если коэффициент по входу блока 31 15 умножения равен (К К„+Я Q) L, а по — 1 входу блока 28 умножения равен R К, 1 то на выходе сумматора 30 будет формироваться сигнал, точно совпадающий с вырэже- 20 нием (4). Коэффициент по входу сумматора

11 равен К, и выбирается в соответствии с выражением (8), а по второму входу — равен

Kz, величина которого определяется по (9).

Как следует из сказанного выше, за счет дополнительно введенных блоков и связей в предложенном устройстве при, Мд.1н t > Л выполняется адаптивная подстройка положения поверхности скольже— 1 ния на основе оценки величин ig чем 30 достигается с учетом электрической постоянной времени электродвигателя 6 максимальное быстродействие электроп ривода при отработке произвольного типа программного задающего воздействия и при 35 наличии значительных величин внешних возмущающих моментов (сухого и вязког7о трения, внешнего нагрузочного момента), Эти свойства выгодно отличают предлагаемое устройство для управления электропри- 40 водом робота от известного. При входе в область, где (Mz« I (A подстройка С1 и С2 прекращается. Но за счет выбора соответствующей величины Л, появляющаяся погрешность всегда может быть сведена к величине, допустимой по условию технической эксплуатации данной системы, так как

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

Формула изобретения

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

1664548

Составитель Е, Политов

Техред М.Моргентал Корректор С. Черни

Редактор О. Хрипта

Заказ 2352 Тираж 469 Подписное

ВНИИПИ Государственного комитета по изобретениям и открытиям при ГКНТ СССР

113035, Москва, Ж-35, Раушская наб., 4/5

Производственно-издательский комбинат "Патент", г. Ужгород, ул.Гагарина, 101 пятого блока умножения, выход которого соединен с третьим входом девятого сумматорэ, а второй вход — с вторым входом шестого сумматора, входом первого квэдратора и выходом одиннадцатого сумматора, подключенного первым входом к выходу задатчика сигнала, а вторым входом — к выходу блока выборки и запоминания.