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

/00, 13 0 51)5 В 2 30 ЕТ И афи еСВИДЕТЕЛ ЬСТВУ АВТОРСКО АНИП ционных сив устройстрмирования ромеханичеого электро- в корпусе ГОСУДАРСТВЕННОЕ ПАТЕНТНОВЕДОМСТВО СССР(56) Авторское свидетельство СВ 553451, кл. В 25 Л 9/00, 1977(54) УСТРОЙ СТВО УП РАВЛ Е НИЛЯТОРОУ(57) Использование: в манипулястемах. Сущность изобретения:ве, включающее устройство фоуправляющих сигналов и электский модуль, индукторы линейндвигателя, смонтированные Изобретение относится к робототехнике и может быть использовано в манипуляционных системах во многих отраслях народного хозяйства,Известны манипуляторы, содержащие устройство формирования управляющих сигналов и автоматизированный линейный электропривод.Наиболее близким к предложенному устройству по технической сущности является графопостроитель - манипулятор с прямоугольной системой координат основных движений. В нем на вход блоков управления линейными электродвигателями подаются электрические сигналы, пропорциональные текущим координатам в виде последовательности импульсов. Подвижные индукторы линейных электродвигателей, перемещаясь вдоль неподвижных якорей, перемещают ленточные передачи, которые, обкатываясь по роликам, перемещают соответствующие каретки ходовых балок, уканеподвижно и попарно на противополокных его сторонах. Соответствующие индукторам подвижные якоря имеют вдоль магнитопровода зубчатые рейки, при помощи которых якоря каждой пары кинематически связаны с зубчатым колесом, смонтированным на корпусе; Один якорь каждой пары неподвижно соединен с ходовой балкой и уравновешен со вторым якорем этой пары, на валу зубчатого колеса смонтированы датчики углового положения и ускорения, выход датчика углового ускорения через аналого-цифровой преобразователь соединен с микропроцессором, 3 ил. занные кинематические передачи с независимыми ветвями повышают точность работы графопостроителя иулучшают динамические характеристики путем возможности уравновешивания подвижнь 1 х частей.Недостатками известного устройства являются малая жесткость и прочностьленточных передач, необходимость устройства контактного или бесконтактного подвода электропитания к подвижному индуктору, а также отсутствие датчика ускорения и микропроцессорных средств управления, позволяющих формировать адаптивный способ управления манипулятором в условиях внешних возмущающих сил.С целью расширения функциональных возможностей и повышения эффективности управления манипулятором, а также повышения точности и надежности его работы, в устройство формйрования управляющих сигналов передают информацию о величине и направлении ускорения управляемого звена, вычисляют движущую силу в течение рабочего цикла, используя информацию о массе подвижных звеньев манипулятора, включая массу груза и формируют соответствующие величины и направления токов, подаваемых в обмотки управления электродвигателя для обеспечения необходимого закона перемещения рабочего органа, причем индукторы линейного электродвигателя смонтированы в корпусе неподвижно и попарно на противоположных его сторонах, соответствующие индукторы подвижные якоря имеют вдоль магнитопровода зубчатые рейки, при помощи которых якоря каждой пары кинематически связаны зубчатым колесом, смонтированным на корпусе, один якорь каждой пары неподвикно соединен с ходовой балкой и уравновешен со вторым якорем этой пары, на валу зубчатого колеса смонтированы датчики углового полокения иускорения, выходдатчикаугловогоускорения через аналого-цифровой преобразователь соединен с микропроцессором.На фиг.1 представлена структурная схема автоматизированного электропривода манипулятора; на фиг.2 - общий вид электромеханического модуля манипулятора; на фиг;3 - то же, с выдвинутой ходовой балкой,Структурная схема содержит устройство формирования управляющихсигналов 1, включающее микропроцессор 2, цифроаналоговый преобразователь 3, усилитель мощ- ности 4, аналого-цифровой преобразователь 5, и электромеханический модуль манипулятора б, включающий линейный электродвигатель 7, датчик положения ходовой балки 8, датчик уСкорения ходовой балки 9. Электромеханический модуль б содержит корпус 10, ходовую балку 11, индукторы линейного электродвигателя 12, 13, смонтированные неподвижно на корпусе 10, подвижные якоря 14, 15, установленные в вращающихся опорах 16. Подвижные якоря 14, 15 имеют вдоль магнитопровода зубчатые рейки 17, кинематически связанные с зубчатым колесом 18, смонтированным при помощи кронштейна 19 на корпусе 10. На валу зубчатого колеса 18 смонтированы датчик углового полокения 8 и датчик углового ускорения 9.Способ управления манипулятором состоит в следующем, управляющий сигнал, необходимый для выполнения перемещения ходовой балки манипулятора на величину 1 поступает на вход микропроцессора 2 отсистемы управления робота. В микропроцессоре 2 и цифроаналоговом преобразователе 3 формируются управляющие сигналы, которые через усилитель мощности 4 под 10 нипулятора, Кроме того; схват манипулято 55 ра может взять груз весом превышающим 15 20 25 30 35 40 45 аются на входы линейного двигателя 7, перемещающего ходовую балку 11 на соответствующую величину . Согласно блок-схеме сигнал обратной связи от датчика положения 8, передается на сравнение с управляющим сигналом цифроаналогового преобразователя 3, разность сигналов вновь поступает на вход усилителя 4 до полной отработки величины 1. Кроме того, сигнал обратной связи от датчика положения 8 передается также через аналого-цифровой двухканальный преобразователь 5 в микропроцессор 2, в котором, при необходимости, производится вычисление по величине сигнала обратной связи действительного значения величиньь текущего положения ходовой балки манипулятора и сравнивается с величиной сигнала от системы управления робота. Таким образом, использование микропроцессора, может повысить эффективность управления, Помимо обратной связи по положению, в блок-схеме имеется обратная связь по ускорению ходовой балки манипулятора. Сигнал от датчика ускорения 9 через аналого-цифровой преобразователь 5 поступает в микропроцессор 2, в котором используется для вычисления 1. Усилий, приложенных к ходовой балке, Если ускорение по направлению совпадает с направлением заданного движения Едв - Гнагр = ва), а также при а = 0 (Гдв = =Рлагр), то в микропроцессоре 2 и цифроаналоговом преобразователе 3, соответственно рассчитываются и формируются напряжения для поддержания скоростей и ускорений ходовой балки для заданного перемещения. В случае не совпадения направления ускорения с направлением заданного движения (Рнагр - Рдв = яд), то В микропроцессоре 2 и цифроаналоговом преобразователе 3, рассчитываются и формируются управляющие напряжения для мгновенного восстановления движения в заданном направлении ходовой балки 11 с компенсацией положения при помощи позиционной обратной связи. Этот случай мокет возникнуть в электроприводе с допустимой неуравновешенностью Ла при превышении величины внешних возмущающих сил над расчетной, с учетом которой проводилась технологическая операция уравновешивания подвижных звеньев мадопустимую норму для данного уравновешенного электропривода, т.е, присоединив дополнительную массу, нарушить характеристики уравновешивания в сторону увеличения Л п, что при допустимых величинах внешних возмущающих сил может привести к несовпадению направления ускорения подвижных звеньев манипулятора с направлением заданного перемещения, Управление электроприводом предложенным способом позволяет сглаживать воздействие внешних возмущающих сил помимо уравновешивания, формировать адаптивный способ управления манипулятором, расширяя его функциональные возможности,2. Усредненных скоростей движения ходовой балки для более плавного перемещения в заданную позицию.Поступательно движущиеся звенья электромеханического модуля манипулятора - подвижный якорь 14 с ходовой балкой 11 с одной стороны и подвижный якорь 15 с другой стороны, являющиеся независимыми ветвями поступательной кинематической передачи, могут быть уравновешены с допустимой погрешностью Л щ в соответствии с известной методикой. Как правило, уравновешивание звеньев улучшает динамические характеристики линейного электропривода, повышает точность работы манипулятора на наклонах, качках, вибрациях и ударах. Предложенный способ и устройство для его реализации позволяет дополнить эффект уравновешивания звеньев манипулятора и значительно улучшить его динамические характеристики с появлением нового качества - возможности перемещения грузов с весом, превышающим допустимую норму для данного уравновешенного электропривода,5Формула изобретения Устройство управления манипуляторомсодержащее блок формирования управляю. щих сигналов, включающий вычислитель ный . блок, цифроаналоговый ианалого-циФровой преобразователи, усилитель мощности и схему сравнения, уравно вешенный линейный электродвигатель,включающий индукторы и якоря, и датчик 15 обратйой связи, о т л и ч а ю щ е е с я тем,что,с целью повышения. точности и йадежности в работе, индукторы смонтированы в корпусе неподвижно и попарно на противоположных его сторонах, а соответствующие 20 индукторам подвижные якоря содержатрасположенные параллельно магнитопроводу зубчатые рейки, кинематически связывающие якоря каждой пары с зубчатым колесом, установленным на корпусе, при 25 этом якорь каждой пары неподвижно соединен с ходовой балкой и уравновешен со вторым якорем этой пары, а на валу зубчатого колеса установлены датчики углового положения и ускорения, причем выход датчика 30 углового ускорения посредством айалогоцйфрового преобразователя соединен с вычислительным блоком.1781024 тор З,Сэлко едакто роизводственно-издательский комбинат "Патент", г, Ужгород, ул,Гагарина, 101 Заказ 4242 ВНИИПИ оставитель С,Грибоехред М.Моргентал Тираж Подписноерственного комитета по изобретениям и открытиям при ГКНТ СССР 113035, Москва, Ж. Раушская наб 4/5