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

СОЮЗ СОВЕТСКИХСОЦИАЛИСТИЧЕСНИХРЕСПУБЛИК 7 К 11) И 9 51)4 С 05 00 В 25 Д 9 0 ПИСАНИЕ ИЗОБРЕТЕНИЯ ВАПРОГРАММИБОТА облас- исполь- управ- изоб- чников осится к ожет быт аммы оботом. В ения исто излучени ьса, трех фровых пр я, двух клю еобратсяра повышаю раммы и умил,еньпаГОСУДАРСТВЕННЫЙ НОМИТЕТ СССРПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТКРЫТИЙ К АВТОРСКОМУ СВИДЕТЕЛЬСТ(71) Ленинградский ордена Ленина политехнический институт им. М.И.Калинина и Центральный научно-исследовательский институт робототехники и .технической кибернетики при Ленинградском ордена Ленина политехническом институте им. М.И.Калинина (72) Б.И.Морозов, Н,М.Довбняи О.Б.Лебедева(56) Авторское свидетельство СССР У 636076, кл. В 25 1 9/00, 1978.Авторское свидетельство СССР В 807216, кл. В 25 3 9/00, 1982.(54) УСТРОЙСТВО ДЛЯ НИЯ ПРОМЫШЛЕННОГО Р(57) Изобретение от ти робототехники и зовано для записи п ления промышленным ретении эа счет вве излучения, приемник формирователеи импу чей, двух аналого-ц зователей; компарат скорости записи про ется объемпамяти.Изобретение относится к робототехнике и может быть использовано для записи программы управления промышленным роботам.Целью изобретения является повышение скорости записи программы путем сокращения времени определения точек прямолинейных участков траектории и упрощения устройства за счет уменьшения объема памяти из-эа уменьшения количества записываемых точек траектории,На чертеже представлена Функциональная схема устройства,На чертеже приняты следующие обозначения: координата 1 вертикального перемещения сигналиэатора, координата 2 .горизонтального перемещения манипулятора, каретка 3, источники 4 излучения, приемник 5 излучения,первый сумматор б,первый ключ 7, первый усилитель 8,первый двигатель 9,первый датчик 10 положения, второйсумматор 11, второй усилитель 12,второй двигатель 13, второй датчик14 положения, блок 15 управления,второй и третий ключи 16 и 17 соответственно, первый и второй аналогоцифровые преобразователи 18 и 19 соответственно, третий сумматор 20,компаратор 21, первый и второй формирователи 22 и 23 импульсов соответ ственно, блок 24 памяти, рабочая поверхность 25, Бэ, П Б - выходные сигналы блока 15 управления,П - выходной сигнал приемника 15излучения, ЛБ - входной сигнал компаратора 21 11 и 11 - входные сигф Х 2налы блока 24 памяти.Устройство работает следуюшимобразом.В процессе записи точек рабочейтраектории оператор с помощью блока15 управления подключает к входу сумматора 11 привода координаты 2. напряжение 11 . В результате этого исполнительный орган перемещается вгоризонтальном направлении (вдольоси х) и останавливается операторомв первой точке - точке начала заданной траектории, в результате этогодвижения каретка 3 перемещается пооси х в эту точку. После выполненияэтого движения оператор с помощьюблока 15 управления подает на управляющий вход формирователя 22 сигнал Б., а на вход сумматора 6 - постоянное значение напряжение П 5 10 15 20 25 30 35 40 45 50 55 В результате этих операций на выходе Формирователя 22 формируется строб, под действием которого ключ 7 открывается и привод координаты 1 вертикального перемещения отрабатывает значение напряжения Б , которое с сумматора 6 через открытый ключ 7 и усилитель 8 поступает на двигатель 9. При подаче напряжения Б привод координаты 1 вертикального перемещения перемещает каретку 3 по высоте до тех пор, пока значение Пне сравняется созначением напряжения П, снимаемым с выхода приемника 5 излучения. Значение напряжения 11 подается на второй вход сумматора 6, и привод вертикального перемещения работает в следящем режиме, отрабатывая рассогласование между значениями напряжений П и Б . Величинаал а напряжения Бвыбирается при настройке устройства и соответствует максимальному значению отраженного сигнала, снимаемому с приемника 5, в случае, когда. оба источника 4 излучения сфокусированы и направлены под разными углами в одну точку.Результаты перемещения координат 1 и 2 измеряются датчиками 10 и 14 положения. После отработки сигнала Бкаретка 3 занимает определенное значение по высоте относительно рабочей поверхности 25, а лучи источников 4 излучения направлены в новую точку. Отработка значения напряжения осуществляется в период действия на управляющий вход ключа,7 импульса строба с формирователя 22. По окончании строба на выходе формирователя 23 формируется импульс, который по дается на управляющие входы ключей . 16 и 17; Эти ключи открываются, и напряжение с датчиков 10 и 14 положения подается на информационные входы преобразователей 18 и 19. В результате преобразования напряжения в последних представлены значения кодов 11 и И , характеризующие положениегфпервой точки рабочей траектории. После этих предварительных операций оператор снова подает на вход сумматора 1 1 напряжение Пу и плавна перемещает каретку 3 вдоль оси х по направлению рабочей траектории, например слева направо. Такое перемещение осуществляется за счет подачи на вход сумматора 11 медленно и линейно изменяющегосянапряжение П.В процессе горизонтального перемещения каретки осуществляется автоматическое снятие существенных точек траектории с установкой каретки 3 на фиксированную высоту. Сущест венными точками кривой считаются точки, в которых кривизна кривой превышает заданное значение допуска. Процесс записи этих точек осуществляется следующим образом. В процессе перемещения каретки 3 на вход сумматора 20 подается текущее значение напряжения П , которое изменяется в процессе перемещения из-за изменения кривизны траектории в заданном направлении движения. На второй вход этого сумматора 20 подается опорное значение напряжения Ц с блока управления. В результате сравнения этих напряжений по величине с выхода сумматора 20 на вход компаратора 21 подается разностное значение напряжения П-Б. На второй вход компаратора 21 приложено напряжение д 11, которое задается исходя из допустимых отклонений траектории, определяемых исходя из требований технологического процесса сварки, окраски и т.й. При сравнении модуля разностного значения на пряжения с допустимым значением ЬП компаратор 21 сработает и с его выхода на управляющие входы пре-. образователей 18 и 19 подается сигнал, по которому их содержимое (коды Ь ; и М , характеризующие поло 7жение предыдущей точки переписывается в блок 24 памяти. Одновременно импульсом с компаратора 21 на выходе формирователя 22 формирует ся строб, который открывает ключ 7 и разностное значение напряжения между П и Бя поступает на двигатель 9Под действием сигнала рассогласования привод координаты 1 45 вертикального перемещения перемещает каретку 3 по оси Е(вверх или вниз) до тех пор, пока значение П не станет равным П , т.е. пока каретка 3 не займет заданное значе ние по высоте. По окончании импульса строба на выходе формирователя 23 формируется сигнал; которым открываются ключи 16 и 17, и значения напряжений, с датчиков 1 О и 14, ха рактеризующие положение координат 1 и 2 в следующей точке, подаются на входы преобразователей 18 и 19. Последующая запись существенных точек заданной кривой, в которых ее крутизна отличается более чем на величину + д Б, осуществляется аналогичным образом. При этом очевидно, что для участков траектории с малой кривизной (Б -Б Сд Б илиоьпрямолинейных участков число записываемых точек будет минимальным.Таким образом, за счет исключения избыточных точек предлагаемое изобрепение позволяет уменьшить объем используемой для записи заданной траектории памяти, аавтоматическое считывание точек траектории сокращает время записи программы.формула из обре тенияУстройство для программирования промышленного робота, содержащее блок памяти, первый сумматор и последовательно соединенные первый усилитель и первый двигатель, механически связанный с первым датчиком положения, последовательно подключенные блок управления, второй сумматор, второй усилитель и второй двигатель механически. связанный с в горым датчиком положения, выход которого соединен с вторым входом второго сумматора, о т л и ч а ю щ е е с я тем, что, с целью повьппения скорости записи программы и упрощения устройства,.оно содержиТ установленные на каретке два источника излучения.и приемник излучения, первый ключ, второй ключ, первый аналого-цифровой преобразователь и последовательно соединенные третий сумматор, компаратор, первый формирователь импульсов, второй формирователь импульсов, третий ключ и второй аналого-цифровой преобразователь, соединенный с первым входом блока памяти, второй вход которого подключен к выходу первого аналого-цифрового преобразователя, соединенного первым входом с выходом компаратора и вторым входом второго аналого-цифрового преобразователя, а вторым входом - с выходом второго ключа, первый вход которого подключен к выходу второго датчика положения, а второй входк выходу второго формирователя импульсов, соединенного входом с первым входом первого ключа, второйвход которого подключен к выходу1 27 7068 Составитель Е.ПолитовТехред В.Кадар Корректор Г.Решетник Редактор Э,Слиган Заказ 6664/40 Тираж 836 Подписное ВНИИПИ Государственного комитета СССР по делам изобретений и открытий 113035, Москва, 1(-35, Раушская наб., д, 4/5Производственно-полиграфическое предприятие, г.ужгород, ул.Проектная, 4 первого сумматора, а выход - к входу первого усилителя, выход приемника излучения соединен с первымивходами первого и третьего сумматоров, подключенных вторыми входамик второму выходу блока управления,третий выход которого соединен свторыми входом первого формирователя импульсов, выход первого датчика положения подклхчен к второмувходу третьего ключа, а второй вход компаратора соединен с входом устройства.