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

 

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

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

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

РЕСПУБЛИК

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

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

ПРИ ГКНТ СССР

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

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4358209/40-08 (22) 05,01.88 (46) 23.07,90. Бюл. М 27 (72) С.В. Емельянов, С.Н. Беляков, С.А. Исаков, Л.Г. Кузнецова. С.К. Коровин и В.И. Сизиков (53) 621 — 229.72(088.8) (56) Авторское свидетельство СССР

М 1495116, кл. В 25 J 13/00, G 05 В 11/00, 1988. (54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ

ПРИВОДОМ РОБОТА (57) Изобретение относится к автоматическому управлению и может быть использовано при создании различных робототехнических систем. Цель изобретения состоит в повышении динамической точности управления приводным электродвигателем. Для этого в устройство, содержащее первый сумматор, первый блок умножения, интегратор, второй сумматор.

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

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

На чертеже представлена схема устройства.

Устройство содержит первый сумматор

1, первый блок 2 умножения, интегратор 3, второй сумматор 4, усилитель 5, усилитель 6

„„ 4 „„1580317 А1 (я)л G 05 В 11/00, В 25 J 13/00 усилитель мощности, электродвигатель, датчик тока, третий сумматор, первый компаратор и первый корректирующий блок, дополнительно введены второй блок умножения, второй компаратор, логический блок, ключ, второй корректирующий блок и четвертый сумматор. Таким образом, в устройстве формируется сигнал управления электродвигателем, содержащий сумму сигнала, пропорционального сигналу рассогласования, сигнала, пропорционального интегралу от сигнала рассогласования, и сигнала операторно-координатной обратной связи, Построенный таким образом сигнал управления электродвигателем позволяет парировать изменения параметров электродвигателя за счет изменения весового коэффициента при интегральной составляющей, а также неконтролируемые изменения моментных возмущений и возмущения, вызванные наличием противоЭДС электродвигателя. 1 з.п. ф — лы, 1 ил. мощности, приводной электродвигатель 7, датчик 8 тока, третий сумматор 9, первый компаратор 10, первый корректирующий блок 11, второй блок 12 умножения, второй компаратор 13, логический блок 14, ключ 15, второй корректирующий блок 16 и четвертый сумматор 17.

Логический блок 14 содержит блоки 18 и 19 умножения, компаратор 20 и задатчик 21.

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

На первый вход первого сумматора 1 подается сигнал заданного значения тока электродвигателя, например, от регулятора

1580317

) +1,09)0 — 1,09<0

W1 1(р)

Т1р+1 ! +1, при 01 >0, -1, при U1 <О

55 скорости. Сигнал с датчика 8 тока, пропорциональный величине тока, протекающего через якорную обмотку электродвигателя, поступает на второй вход первого сумматора 1, Сигнал рассогласования между заданным и действительным значением тока, определяемый в сумматоре 1, усиливается в усилителе 5 и через второй сумматор 4 и усилитель 6 мощности поступает на объект управления — электродвигатель 7 (постоянного тока), вызывая увеличение тока в его якорной обмотке.

Выходной сигнал третьего сумматора 9 имеет вид

09=01+К104 - К208; где К1, К2 — коэффициенты усиления третьего сумматора по соответствующему входу, которые выбираются исходя из параметров электродвигателя 7 и усилителя 6 мощности;

U1, 04, U8 u Ug — соответственно выходные напряжения блоков 1, 4, 8 и 9.

Компаратор 10 реализует функцию

01o=SlgnUg, т.е.

Единичный выходной сигнал поступает на вход корректирующего блока 11, реализующего передаточную функцию вида пРичем Т1 < Тэм, !

=я где Т м= — — электромагнитная постоянная

Rg времени электродвигателя.

Сигнал с блока 11 поступает на блок 12 умножения, где умножается на выходной сигнал компаратора 13 (01з), соответствующий знаку сигнала рассогласования устройства, т.е.

01з=й9п U1, т.е.

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

Выходной сигнал блока 12 умножается в блоке 2 умножения на сигнал рассогласования и поступает на вход интегратора 3, выходной сигнал которого является интегральной составляющей сигнала управления электродвигателем 7. B сумматоре 4 осуществляется суммирование пропорционал ь5

40 ной и интегральной составляющих сигнала управления электродвигателем.

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

В логическом блоке 14 на основании информации о знаке и "расстоянии" изображающей точки до линии переключения, а также информации о знаке сигнала рассогласования формируется сигнал операторнокоординатной обратной связи (ОКОС).

Умножая выходной сигнал сумматора 9 на его знак (выходной сигнал компаратора

10 соответствует знаку Ug), на выходе блока

18умножения получается модуль выходного сигнала сумматора 9. В блоке 19 умножения этот сигнал умножается на сигнал, соответствующий знаку сигнала рассогласования устройства (01з), В результате этого на первом выходе логического блока 14 (выход блока 19 умножения) формируется сигнал ОКОС, осуществляющей парирование неконтролируемых моментных возмущений на выходном валу электродвигателя.

Вид сигнала ОКОС определяется в логическом блоке 14 по величине сигнала с выхода сумматора 9 (09).

Если модуль U9!> U21, где U21 — величина порогового сигнала, задаваемого задатчиком 21, ключ 15 разомкнут и на сумматор 17 поступает только сигнал с выхода блока 19 умножения с весовым коэффициентом К8, Если lUgl< U21, ключ 15 замкнут и на входы сумматора 17 поступают сигналы с выхода ключа 15 с весовым коэффициентом К4 и с выхода корректирующего блока 16 с весовым коэффициентом, равным 1., Следовательно, сигнал 0КОС определяется как к8 l U9 !3!9п U1,! Ug l >021; (К8+К4+УУ16(р) !Ug l sign 01,l Ug <021ð где м/18(р)

1 передаточная функТ2р +1 ция корректирующего блока 16;

Т2-T м, Тм — механическая постоянная времени электродвигателя, К4 и Ke — коэффициенты усиления сумматора 17 по соответствующему входу, выбираемые в зависимости от параметров электродвигателя 7 и диапазона действующих моментных возмущающих воздействий.

1590317

При подаче на первый вход первого сумматора 1 сигнала типа i(1) напряжение на выходе сумматора 9 положительно, Сигнал, соответствующий знаку этого сигнала, с выхода компараторэ 10 поступает на вход кор- 5 ректирующего блока 11, выходной сигнал которого плавно увеличивается, увеличивая сигнал, поступающий на вход интегратора

3, следовательно, и величину интегральной составляющей сигнала управления. 10

При IUgl > Uz1, ключ 15 разомкнут и сигнал управления электродвигателем определяется как

Uynp = К501 + К7./ I U1 I,U11dt + о

+ Кв I Ug I sign 01

20 где К7 — коэффициент усиления сумматора 4 по соответствующему входу, выбираемый исходя из требований, предьявляемых к виду переходного процесса и параметров электродвигателя 7.

Второе слагаемое сигнала управления позволяет парировать изменение параметров электродвигателя, а третье — неконтролируемые изменения моментных возмущающих воздействий.

В процессе отработки устройством заданного значения тока уменьшается сигнал рассогласования (U1), увеличивается значение выходной координаты (0в) и сигнал (Ug) на выходе сумматора 9 изменяет свой знак.

Изменение знака Ug приводит к изменению знака выходного напряжения второго компаратора 10 и выходной сигнал второго корректирующего блока 11 плавно умень- 40 шается, уменьшая тем самым интегральную составляющую сигнала управления электродвигателем.

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

Уменьшение значения сигнала Ug приводит к тому, что выполняется условие

I Ug I < Uz1 и сигнал управления электродвигателем определяется как

Оупр = K5U1 + К7./ U1I 011! б1+ о

+ Ks l Ug l sign U1 + К4 I Ug I sign U1.+

+ 9 16 I Ug I sign U1 .

Четвертое слагаемое сигнала управления увеличивает составляющую сигнала управления, парирующую изменения моментных возмущающих воздействий.

Пятое слагаемое позволяет парировать не только моментные возмущения, но и возмущения, вызванные наличием противоЭДС в электродвигателе и погрешностью определения скорости изменения тока электродвигателя, причем введение первого корректирующего блока 16 позволяет уменьшить перерегулировэние, вызванное изменением моментных возмущений.

В установившемся режиме в устройстве устанавливается постоянный коэффициент при интегральной составляющей и некоторое постоянное значение сигнала 0К0С, В случае изменения сопротивления R<, вызванное как девиацией R, так и разбросом значений Rg для многодвигательных роботов, например ромбических манипуляторов, изменяется момент изменения знака сигнала Ug, т.е. изменяется весовой коэффициент при интегральной составляющей сигнала управления электродвигателем, обеспечивая тем самым инвариантность показателей качества переходного процесса к изменению сопротивления якорной цепи электродвигателя.

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

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

1580317 второго блока умножения подключен к выходу первого корректирующего блока, Составитель И.Афонин

Редактор Н. Рогулич Техред М.Моргентал Корректор М.Самборская

Заказ 2011 Тираж 680 Подписное

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

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

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

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

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

15 вторым выходом логического блока,