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

 

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

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

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

РЕСПУБЛИК (st)s В 25 J 9/00, 13/00

ГОСУДАРСТВЕННОЕ ПАТЕНТНОЕ

ВЕДОМСТВО СССР (ГОСПАТЕНТ СССР)

Й, t r.",.

ОПИСАНИЕ ИЗОБРЕТЕНИЯК АВТОРСКОМУ СВИДЕТЕЛЬСТВУ

ОО

, ыЪ

1с) ф (21) 4879853/08 (22) 20,08,90 (46) 15,12.92. Бюл. N 46 (75) Ю.M,Îñèïîâ (56) Авторское свидетельство СССР

N553451,,кл. В 25 J 9/00, 1977, (54) УСТРОЙСТВО УПРАВЛЕНИЯ МАНИПУЛЯТОРОМ (57) Использование: в манипуляционных системах. Сущность изобретения: в устройстве, включающее устройство формирования управляющих сигналов и электромеханический модуль; индукторы линейного электродвигателя, смонтированные в корпусе

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

Наиболее близким к предложенному устройству по технической сущности является графопостроитель — манипулятор с прямоугольной системой координат основных движений. В нем на вход блоков управления линейными электродвигателями подаются электрические сигналы, пропорциональные текущим координатам в виде последовательности импульсов. Подвижные индукторы линейных электродвигателей, перемещаясь вдоль неподвижных якорей, перемещают ленточные передачи, которые, обкатываясь по роликам, перемещают соответствующие каретки ходовых балок, ука„„Ы „„1781024 А1 неподвижно и попарно на противополо>кных его сторонах. Соответствующие индукторам подвижные якоря имеют вдоль магнитопровода зубчатые рейки, при помощи которых якоря каждой пары кинематически связаны с зубчатым колесом, смонтированным на корпусе; Один якорь каждой пары неподвижно соединен с ходовой балкой и уравновешен со вторым якорем этой пары, на валу зубчатого колеса смонтированы датчики углового положения и ускорения, выход датчика углового ускорения через аналого-цифровой преобразователь соединен с микропроцессором. 3 ил. занные кинематические передачи с независимыми ветвями повышают точность работы графопостроителя и улучшают динамические характеристики путем возможности уравновешивания подвижных частей.

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

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

На фиг.1 представлена структурная схема автоматизированного электропривода манипулятора; на фиг.2 — общий вид электромеханического модуля манипулятора; на фиг;3 — то же, с выдвинутой ходовой балкой.

Структурная схема содержит устройство формирования управляющих сигналов 1, включающее микропроцессор 2, цифроаналоговый преобразователь 3, усилитель мощ- ности 4, аналого-цифровой преобразователь 5, и электромеханический модуль манипулятора 6, включающий линейный электродвигатель 7, датчик положения ходовой балки 8, датчик уСкорения ходовой балки 9. Электромеханический модуль 6 содержит корпус 10, ходовую балку

11, индукторы линейного электродвигателя

12, 13, смонтированные неподвижно на корпусе 10,. подвижные якоря 14, 15, установленные в вращающихся опорах 16.

Подвижные якоря 14, 15 имеют вдоль магнитопровода зубчатые рейки 17, кинематически связанные с зубчатым колесом 18, смонтированным при помощи кронштейна

19 на корпусе 10. На валу зубчатого колеса

18 смонтированы датчик углового поло>кения 8 и датчик углового ускорения 9.

Способ управления манипулятором состоит в следующем, управляющий сигнал, необходимый для выполнения перемещения ходовой балки манипулятора на величину 1 поступает на вход микропроцессора 2 от системы управления робота. В микропроцессоре 2 и цифроаналоговом преобразователе 3 формируются управляющие сигналы, которые через усилитель мощности 4 под10 нипулятора. Кроме того; схват манипулято55 ра может взять груз весом превышающим

45 аются на входы линейного двигателя 7, перемещающего ходовую балку 11 на соответствующую величину l. Согласно блок-схеме сигнал обратной связи от датчика положения 8, передается на сравнение с управляющим сигналом цифроаналогового преобразователя 3, разность сигналов вновь поступает на вход усилителя 4 до полной отработки величины I. Кроме того, сигнал обратной связи от датчика положения 8 передается также через аналого-цифровой двухканальный преобразователь 5 в микропроцессор 2, в котором, при необходимости, производится вычисление по величине сигнала обратной связи действительного значения величинь(текущего положения ходовой балки манипулятора и сравнивается с величиной сигнала от системы управления робота. Таким образом, использование микропроцессора, может повысить эффективность управления. Помимо обратной связи по положению, в блок-схеме имеется обратная связь по ускорению ходовой балки манипулятора. Сигнал от датчика ускорения

9 через аналого-цифровой преобразователь

5 поступает в микропроцессор 2, в котором используется для вычисления

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

Fpe — FHarp = ma), а также при а = 0 (Fpe =

=F>rarp), то в микропроцессоре 2 и цифроаналоговом преобразователе 3, соответственно рассчитываются и формируются напряжения для поддержания скоростей и ускорений ходовой балки для заданного перемещения. В случае не совпадения направления ускорения с направлением заданного движения (Fvarp Fpa = m8), то в микропроцессоре 2 и цифроаналоговом преобразователе 3, рассчитываются и формируются управляющие напряжения для мгновенного восстановления движения в заданном направлении ходовой балки 11 с компенсацией положения при помощи позиционной обратной связи. Этот случай мо>кет возникнуть в электроприводе с допустимой неуравновешенностью Лm при превышении величины внешних возмущающих сил над расчетной, с учетом которой проводилась технологическая операция уравновешивания подвижных звеньев мадопустимую норму для данного уравновешенного электропривода, т.е, присоединив дополнительную массу, нарушить характеристики уравновешивания в сторону увели1781024 чения Л m, что при допустимых величинах внешних возмущающих сил может привести к несовпадению направления ускорения подвижных звеньев манипулятора с направлением заданного перемещения. Управление электроприводом предложенным способом позволяет сглаживать воздействие внешних возмущающих сил помимо уравновешивания, формировать адаптивный способ управления манипулятором, расширяя его функциональные возможности.

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

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

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

его динамические характеристики с появлением нового качества — возможности перемещения грузов с весом. превышающим допустимую норму для данного уравновешенного электропривода, 5

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

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

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

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

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

1781024

f7 6

Составитель С,Грибов

Техред М.Моргентал

Корректор 3,Сэлко

Редактор

Производственно-издательский комбинат "Патент", г, Ужгород, yn,Гагарина, 101

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

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

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