Устройство для управления приводом манипулятора
Изобретение относится к робототехнике. Целью изобретения является повышение быстродействия и улучшение качества переходных процессов. Для этого в устройство введены два сумматора, релейный элемент, интегратор, три блока умножения, корректор и блок деления, обеспечивающие подстройку параметров регулятора. 2 ил.
СОЮЗ СОВЕТСКИХ
СОЦИАЛИСТИЧЕСКИХ
PЕСПУБЛИК (!9) (Il) (и)з В 25 J 13/00
ГОСУДАРСТВЕ)+Ь(й KOHNTET
ПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМ
ПРИ ГКНТ СССР
ОПИСАНИЕ ИЗОБРЕТЕНИЯ (56) Авторское свидетельство СССР
М 1496999, кл. В 25 J 13/00, 1988, K АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4633373/08 (22) 06.01,89 (46) 30.08,91, Бюл. hL 32 (71) Дальневосточный политехнический институт им. В,В. Куйбышева (72) А.А. Дыда и В.Ф. Филаретов (53) 621,229,72(088.8) Изобретение относится к робототехнике и может быть использовано при создании приводов манипулятора, Целью изобретения является повышение быстродействия и улучшение качества переходных процессов за счет компенсации влияния быстроизменяющихся параметров нагрузки.
На фиг. 1 представлена функциональная схема устройства; на фиг. 2 — кинематическая схема манипулятора.
Устройство содержит сумматор 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, четвертый и пятый усилители 2б и 27 соответственно, пятый блок 28 умножения, шестой усили2 (54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ
ПРИВОДОМ МАНИПУЛЯТОРА (57) Изобретение относится к робототехнике. Целью изобретения является повышение быстродействия и улучшение качества переходных процессов. Для этого в устройство введены два сумматора, релейный элемент, интегратор, три блока умножения, корректор и блок деления, обеспечивающие подстройку параметров регулятора, 2 ил. тель 29, седьмой сумматор 30, четвертый задатчик 31 сигнала, первый функциональный преобразователь 32, шестой блок 33 умножения, восьмой сумматор 34, блок 35 деления, девятый сумматор 36, интегратор
37, второй функциональный преобразователь 38, седьмой блок 39 умножения, восьмой блок 40 умножения, Устройство работает следующим образом.
Устройство управляет обобщенной координатой q>. Приведенная на фиг. 2 схема построения наиболее типична для роботов, работающих в цилиндрической системе координат. При данной конструкции манипулятора возможны также вертикальное перемещение груза (обобщенная координата цг) и его горизонтальное перемещение (обобщенная координата оэ).
Моментные характеристики привода, управляющего координатой q>, существенно зависят от координат оз и оэ. Запишем уравнение динамики привода поворота. Для этого воспользуемся уравнением Лагранжа
2-го рода. Кинетическая энергия Т движу щихся масс исполнительного органа робота при о2=const может быть представлена в
1673433 виде: т = -11ql + — М! +-ma(la + язв + уполз + яз+ 1зЯ+ фа — пз1я3, 1 . 1, 1 е . 1 ° 1.
2 2 2 где Is — момент инерции вертикального зве- 5 на исполнительного органа массой m2 относительно продольной оси;
IN — момент инерции горизонтального звена исполнительного органа массой m3 относительно поперечной оси, проходящей 10 через центр масс; ! — момент инерции робота двигателя и вращающихся частей редуктора; !
3* — исходное расстояние от оси вращения горизонтального звена до его центра 15 масс (при цэ=О); ! э — расстояние от центра масс горизонтального звена до средней точки схвата;
m — масса захваченного груза.
С учетом того, что 20 дТ .. *
- =!зц1+!мц!+гпэ(!э +цэ) q1+m 01 .!1 ! 3) q1 d дТ * г" 4 — =(Is+IN)q1+m3(13 +цэ) q1+2m3(13 + dt ag1 цэ); qiq3+mgl3*+q3+l3) q 2+2m(l3*+q3+l3)q iq3" дТ х-@ — =О 30 можно записать, моментное воздействие на привод поворота имеет вид: МЬ=Н(цэ)ц 2+Л(цэ,цз)ц1, (1) где H=H(q3)=m3(l3 +цф +m/13*+q3+I3) +Is+IN; h=h(q3,q3)=2(m3(l3 +цэ)+гп (!э +цэ+!3))цэ . (2) Учитывая соотношения (1) и (2), исполнительный двигатель постоянного тока с независимым возбуждением достаточно точно можно описать передаточной функцией 45 (+ Rÿ.h(Kм) Kr ap —,—, .121 wg(P) ря; P — символ дифференцирования. 55 Для большего удобства передаточную функцию перепишем в виде: (4) где Kg=(Ксо +Ряб/Км) — коэффициент передачи двигателя по скорости, Тд=йя(Н+ !)/(пйя+КмКг22 )-его постоянная времени. где KM — моментный коэффициент двигате- 50 ля; Ксо — коэффициент противоЭДС, Вя — активное сопротивление цепи якоСоотношения (3) и (4) справедливы для двигателей постоянного тока с достаточно малой электрической постоянной времени, что имеет место для большинства современных исполнительных двигателей. При ненулевых начальных условиях или при подаче ступенчатого задающего сигнала в рассматриваемом устройстве возникает скользящий процесс за счет смены структуры, которая происходит при переключении релейного элемента 11, реализующего функцию slgnX, Уравнение линии переключения имеет вид S =се+я=О, (5) где е, е — сигнал рассогласования и его производная. c — наклон линии переключения. Для 1ого, чтобы прямая S=O являлась линией скольжения, требуется, чтобы в ее окрестности выполнялось условие; SS <О (6) Динамика устройства с учетом (4) описывается следующей системой дифференциальных уравнений: е! =e2 ег = — а2Р2 — b/e>/sign S, (7) где e1 = e,, а2=1/ Тд,Ь=К yK gK р/Tg, К y, Kg— коэффициенты передачи усилителя 4 и редуктора 6 соответственно. При учете воэможности непрерывной настройки параметра С из (5) получаем: S = c6 + e2 + cei, или согласно (7); S(c с +а2с bslgnS e ) e, (8) Из (8) следует, что условие (6) выполняется, если выполнено условие: C=C -агС+ЬЗ!цп$Е (9) где b — коэффициент, удовлетворяющий соотношению Ь>Ь)0, На основе уравнения (9) в устройстве выполняется непрерывная подстройка параметра С. Дпя этого требуется сформировать сигналы, соответствующие Тд и Кд. Формирование этих сигналов осуществляется следующим образом. Вычисленная в сумматоре 12 сумма сигналов цэ, измеряемого датчиком положения горизонтального звена манипулятора, и !3, поступающего с блока 13 через квадратор 14 и усилитель 15, имеющий коэффициент передачи тэ, подается на сумматор 16. Этот же суммарный сигнал цэ+!3* складывается в сумматоре 20 с сигналом !3, поступающим с блока 21, и через квадратор 22 подается на блок умножения 23, где он умножается на сигнал тактильного датчика схвата, соответствующий массе груза m1., и складывается в сумматоре а 2 16 с сигналом гпэ(!э +цэ) и сигналом Is+IN+I, поступающим с выхода блока 17. 1673433 В результате на выходе сумматора 16 получается сигнал, равный: вз(lз +рз)з+вг (Iэ +рз+1 зР+!з+1м+1. т.е. Н+1 см. (2). Выходной сигнал рз+!з +1з сумматора 20, умножаясь в блоке умножения 24 на сигнал вг, суммируется с сигналом рз+lз, усиленным в вз раэ усилителем 26. В результате выходной сигнал сумматора 25 равен вз(рз+1з*)+в(рз+!з +Iз), Этот сигнал, усиленный вдвое усилителем 27, умножается в блоке 28 умножения на сигнал рз, снимаемый с датчика скорости горизонтального звена манипулятора. Таким образом, на выходе блока 28 умножения формируется сигнал h(см. выражение (2)). Сигнал h, усиленный в усилителе 29 bRg/KM раз, складываясь в шестом сумматоре 30 с сигналом К „, поступающим с блока 31, подается на вход функционального преобразователя 32, реализующего вы. числение зависимости 1 (Х)=Х . Поэтому на выходе функционального преобразователя 32 сигнал имеет вид: (К,д +Rph/Км), т.е. Кя (см. (4)). На этот сигнал в блоке умно:кения 19 умножается сигнал H+I, предварительно усиленный в Вя/Км раз усилителем 18. Таким образом, выходной сигнал блока умножения 19 определяется как Rp(I+H) /(KMKg)=R я(Н+ I) /(KM(K,,+ R qh/ Км)= =Tg, Одновременно на выходе релейного элемента 40 формируется сигнал signa, который умноженный в блоке 41 умножения на выходной сигнал slgnS релейного элемента 11, поступает на вход блока умножения 33. На другой вход этого блока подается сигнал Кя с выхода функционального преобразователя 32. Выходной сигнал блока умножения 33, имеющий вид Kg slgnSE, складывается в сумматоре 34 с сигналом "С", поступающим с выхода интегратора 37, и подается на вход блока деления 35, на второй вход которого поступает сигнал Tg c выхода блока умножения 19, Анализ и моделирование показывает, что для более быстрой настройки "С" требу/сг ется выбирать коэффициент b достаточно близким к b. Для устранения возможности нарушения скользящего режима иэ-эа погрешностей в работе устройства выберем Ь=(0,8 — 0,95)b, т.е. с определенным запасом, который может быть тем меньше, чем меньше погрешности используемых блоков. В связи с этим коэффициент передачи по первому входу сумматора 34 выбирается равным (0,8 — 0,95)КуКр. В итоге на выходе блока деления 35 сигнал имеет вид -ajc+bslgnSe далее сум5 55 мируется в сумматоре 36 с сигналом С, поступающим с выхода квадратора 42. Поэтому на входе интегратора 37 формируется сигнал с -agc+bslgnSe, т.е. согласно (9), С, а на выходе интегратора 37 — сигнал С, Таким образом, в блоках 34-37 и 42 реализуется определение С. С выхода интегратора 37 через функциональный преобразователь 38 сигнал С поступает на блок умножения 39, Второй функциональный преобразователь 38 описывается соотношением: Смин С < Смин v=(","" С Смин (10) где смнн > 0 значение С, которое при любых Kg u Tg обеспечивает возникновение скользящего режима и может быть равным, например 0,01-0,005. Значение Смнн>0 требуется для того, чтобы при нулевых начальных условиях на интеграторе 37 сигнал е передавался через блок умножения 39 к релейному элементу 11 для его правильного переключения. Сигнал на выходе функционального преобразователя 38, как видно из (10), практически равен С (при смнн близком к нулю). Умножение его на е в блоке умножения 39 и сложение с сигналом датчика скорости 9 в сумматоре 10 дает на выходе последнего сигнал S (при надлежащем выборе коэффициентов передачи входов сумматора 10). Таким образом, в устройстве обеспечивается такая подстройка положения линии переключения, при которой возникает скользящий режим работы, переходные процессы имеют апериодический характер. В прототипе настройка С выполняясь в предположении квазистационарности параметров, в связи с чем синтез прототипа основывался на алгебраических операциях, Работоспособность прототипа могла нарушаться при достаточно быстром изменении параметров Tg и К>, которое весьма характерно для манипуляторов. В предлагаемом устройстве нестационарность укаэанных параметров учитывается введением дополнительного контура динамического определения С. Формула изобретения Устройство для управления приводом манипулятора, содержащее последовательно соединенные первый сумматор, выпрямитель, первый блок умножения, первый усилитель и двигатель, связанный с датчиком скорости непосредственно и через редуктор — с датчиком положения, выход которого подключен к первому входу первого сумматора, соединенного вторым входом 1673433 35 с первым входом устройства, выход датчика скоростью через последовательно подключенные второй сумматор и первый релейный элемент соединен с вторым входом первого блока умножения, э также последовательно подключенные третий сумматор, соединенный первым входом с выходом первого задатчика сигнала, э вторым входом — с вторым входом устройства, первый квэдратор, второй усилитель, четвертый сумматор, подключенный вторым входом к выходу второго задатчикэ сигнала, третий усилитель и второй блок умножения, кроме того, пятый сумматор, первый вход которого подсоединен с выходу второго сумматора, второй вход — к выходу третьего задатчика сигнала, э выход через последовательно подключенные второй квадратор и третий блок умножения — к третьему входу четвертого сумматора, а также последовательно соединенные четвертый усилитель, шестой сумматор, подключенный вторым входом к выходу четвертого блока умножения, пятый усилитель, пятый блок умножения, соединенный вторым входом с третьим входом устройства, шестой усилитель, седьмой сумматор, подключенный вторым входом к выходу четвертого задатчика сигнала, и первый функциональный преобразователь, выход которого соединен с вторым входом второго блока умножения, вход четвертого усилителя подключен к выходу третьего сумматора, выход пятого сумматора соединен с первым входОм четвертого блока умножения, подключенного Вторым входом к второму входу третьего блока умножения, подключенный вторым входом к второму 5 входу третьего блока умножения и четвертому входу устройства, и, кроме того, восьмой и девятый сумматоры, блок деления, шестой блок умножения и второй функциональный преобразователь, отл ич эю щееся тем. 10 что, с целью повышения быстродействия и улучшения качества переходных процессов, оно дополнительно содержит интегратор, третий квадратор, седьмой блок умножения и последовательно соединенные второй ре15 лейный элемент и восьмой блок умножения, второй вход которого подключен к выходу первого релейного элемента, а выход — к первому входу шестого блока умножения, соединенного вторым входом с выходом 20 первого функционального преобразователя, а выходом через последовательно подключенные восьмой сумматор, блок деления, девятый сумматор, интегратор и второй функциональный преобразовэтель— 25 к первому входу седьмого блока умножения, выход которого соединен с вторым входом второго сумматора, а второй вход — с выходом первого сумматора и входом второго релейного элемента, а выход интегратора 30 подключен к второму входу восьмого сумматора и входу третьего квадратора, соединенНОГО ВЫХОДОМ С 8TOpbIM ВХОДОМ ДВВятоГО сумматора. 1673433 @UZ.7 1673433 Составитель А.Моисеенко Редактор Г,Мозжечкова Техред М.Моргентал Корректор М. Максимишинец Заказ 2888 Тираж 444 Подписное ВНИИПИ Государственного комитета по изобретениям и открытиям при ГКНТ СССР 113035, Москва, Ж-35, Раушская нэб., 4/5 Произаодстаанно-издатазкскии комбинат "Пэтант, г. Ужгород, yh,Ãàrhðèíh, 101
