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

 

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

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

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

РЕСПУБЛИК

А1 ((9(SU (ii) g 4 6 05 В 11/01

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

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ

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

ПО ДЕЛАМ ИЗОБРЕТЕНИЙ И OTHPblTHA.(21) 3611763/24-24 (22) 09.06.83 (46) 15. 11.87. Бюл. У 42 (71) Дальневосточный политехнический институт им. В.В.Куйбышева (72) E.Ô.Ôèëàðåòoâ (53) 62-50(088.8) (56) Авторское свидетельство СССР

У 830293, кл. С 05 В 11/01, 1981.

Авторское свидетельство СССР

В 1142810, кл. G 05 В 11/01, 1983. (54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРИВОДОИ РОБОТА (57) Изобретение относится к области автоматического управления. Целью изобретения является повышение точности. Электропривод промышленных роботов при работе с различными грузами, а также за счет взаимовлияния степеней подвижности исполнительного.органа, обладает переменнымя ха рактеристиками. Для обеспечения инвариантности электропривода вводится последовательное корректирующее звено, параметры которого вычисляются в вычислительном блоке на основании информация о массогабаритных параметрах робота, типа используемого двигателя, скорости перемещения горизонтального звена. 1 з.п. ф-лы, 2 ил.

1352450

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

На фиг. 1 представлена блок-схема устройства управления приводом робота по обобщенной координате;на фиг. 2-10 схема исполнительного органа робота.

На чертежах приняты следующие обозначения: q,„ q, q — обобщенные координаты робота; I — момент инерции вертикального звена исполнительного органа массой m относительно продольной оси; Irr — момент инерции горизонтального звена исполнительнос го органа массой m> относительно поперечной оси, проходящей через 20 центр масс; Т вЂ” момент инерции оотора двигателя координаты о,; ез исходное расстояние от оси вращения горизонтального звена до его центра масс (при q = О); 1з — рас- 25 стояние от центра масс горизонтального звена до средней точки схвата;

m — масса захваченного груза.

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

7, второй блок 8 умножения, вычислительный блок 9, состоящий из второго сумматора 10, первого квадратора 11, третьего блока 12 умножения, третьего сумматора 13, второго квадратора

14, четвертого сумматора 15, пятого 40 сумматора 16, шестого сумматора 17, четвертого блока 18 умножения, пятого блока 19 умножения и второго усилителя 20.

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

Сигнал управления после коррекции в блоках 1,2,4 и 8, усиливаясь, поступает на электродвигатель 7, приво-. дя его вал во вращательное движение с направлением и скоростью (ускорением), зависящим от величины поступающего сигнала Р и внешнего моментного воздействия М .

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

Из уравнения Лагранжа 2-го рода определяют моментное воздействие на поворотный привод, которое имеет вид (3)

Км/ (КмК +НИ 1 ) (Т (H + I) /(hR +K K„) ) р+1

К вЂ” моментный коэффициент двигателя;.

К вЂ” коэффициент противоЭДС;

R — активное сопротивление якор9 ной цепи; р — символ дифференцирования;

К вЂ” коэффициент усиления перво- го усилителя 6.

При выводе соотношения (3).электромагнитной постоянной времени двигателя ввиду ее малости пренебрегалось.

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

К /К(д (4) то для обеспечения инвариантности электропривода поворота к изменяющимся параметрам нагрузки необходимо

1 чтобы он всегда описывался только выражением вида (4) независимо от значения М,». Для этого в прямую цепь реальной системы, описываемой передаточной функцией (3), достаточно ввести последовательно корректирующее звено вида

М5 H(q3)q + h (2„q5, )q,, где Н = H(q>) = тп (1 + о,) + ш,.»

h = h(q,,q,) = 2 ((1+ + q>)

+m.(1, + q, + 1,))q3.

С учетом соотношений (i) и (2) электропривод поворота на базе электродвигателя постоянного тока с независимым возбуждением достаточно точно можно описать передаточной функцией вида

1352450 п(р) = W(p) V,(e) Р Тст -- — p)—

1 5 (K Кд + R h) (К (H+I)

КцКм КмКи+ Кяп (5) ц м

Из выражений (2) и (5) видно,что параметры корректирующего устройства n(p) (h U Н) необходимо непрерывно подстраивать под их текущие значения, так как 15

Н=H(q,,m), àh=h(q» ц., m)

Формирование корректирующего устройства (5) осуществляется с помо- 20 щью вычислительного блока 9.

На первый, второй, третий, четвертый и шестой вход вычислительного блока 9 поступает информация о массогабаритных параметрах робота, соответственно (I +I + I); 1,,о,1., и ш, на пятый вход — информация о типе используемого двигателя

К К, а на седьмой — информация о. м скорости перемещения горизонтального 30 звена.

Вычисление величины — h (q,q ) производится в блоках 10, 15, 16, 18 и

19(2),причем суммирование по первому входу четвертого сумматора 15 производится с коэффициентом, равным m>.

Просуммировав с коэффициентом, равным

2R, сигнал = h(q,q,) в шестом сум1 ю 2 э

40 маторе 17 с входным сигналом К„К, и усилив полученную сумму во втором усилителе 20, имеющим коэффициент усиления равный 1/К К, на первом выходе вычислительного блска получат 45 сигнал, пропорциональный коэффициенту усиления последовательного корректирующего звена n(P) (5).

Вычисление величины H+I (2) производится в блоках 10 -14 и 16,причем суммирование по третьему входу третьего сумматора 13 производится с коэффициентом равным m>, Поделив в блоке 5 деления сигнал H+I с выхода третьего сумматора 13 на сигнал

К К + R„h с выхода шестого сумма" м а тора 17, на выходе блока деления имеют сигнал, равный (H+I)/(К„,К +

+ R„h).

Учитывая,что передаточная функция апериодического звена 4 имеет вид

Чд(р) = 1/(р+1), а передаточRgI м а ная функция инерционного дифференцирующего звена 1 — вид W<(p) = R„ р/

/(= р+1) на выходе первого блоRQI

КмКИ ка умножения 2 имеют сигнал

Перемножив с помощью второго блока 8 умножения этот сигнал и сигнал с выхода второго усилителя 20, на выходе второго блока умножения 8 имеют сигнал,К„К„+ Rgh) (К„(H+I) „) ц () КмКЧ КчКы Ня1 ((R, If K„K ) I+1 (б), х 3(t).

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

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

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

1352450 входами блока деления, а входы вычислительного блока являются входами устройства.

2. Устройство по п. 1, о т л ич а ю щ е е с я тем,что вычислительный блок выполнен в виде последовательно соединенных второго сумматора, первого квадратора,третьего бло- 10 ка умножения, третьего сумматора, второй вход которого соединен с первым входом вычислительного блока, а третий — с выходом второго квадратора, вход которого соединен с первым 15 входом четвертого сумматора и выходом пятого сумматора, первый вход которого соединен с первым входом второго сумматора и вторым входом вычислительного блока,а второй — с 20 вторым входом второго сумматора и третьим входом вычислительного блока, четвертый вход которого соединен с третьим входом второго сумматора, пятый — с первым входом шестого сумматора, а шестой — с вторым входом третьего блока умножения и первым входом четвертого блока умножения, второй вход которого соеди; нен с выходом второго сумматора, а выход — с вторым входом четвертого сумматора, выход которого соединен с первым входом пятого блока умножения, второй вход которого соединен с седьмым входом вычислительного блока, а выход — с вторым входом шестого сумматора, выход которого соединен с входом второго усилителя р при этом выходы третьего сумматора шестого сумматора и второго усилителя соответственно являются третьим, вторым и первым выходами вычислительного блока.

1352450 el фиеЯ

Составитель Г.Нефедова

Редактор Л.Повхан Техред А.Кравчук

Корректор В. Гирняк

Заказ 5565/47 Тираж 8б3

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

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

Подписное

Производственно-полиграфическое предприятие, г. Ужгород, ул. Проектная, 4