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

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

Иллюстрации

Показать все

Реферат

 

ОПИСАНИЕ

ИЗОБРЕТЕНИЯ

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

Союз Советских

Социалистических

Республик

««970320 (61) Дополнительное к авт. свид-ву (22) Заявлено10 ° 04. 81 (21) 3275297/18-24 с присоединением заявки ¹ (23) Приоритет

Опубликовано 3010.82. Бюллетень № 40 Дата опубликования описания 30.10.82 (31) М. Кл.з

G 05 В 19/00

В 25 J 9/00

Государственный комитет

СССР по делам изобретений и открытий (S3) УДК 62-50 (088. 8) Г.И. Сергацкий, A.Ñ. Лихошва, Г.A. Ли ин и К,П, Гурский

)I

А,. с

Киевский институт автоматики им ХХЧ сааб„"-ща Се=и.ОРдена

Ленина и ордена Трудового Красного ЗнаменйййстйтуФ.-: электросварки им. Е, О. Патона АН Украинской ССР (72) Авторы изобретения (71) Заявители (54) УСТРОИСТВО ДЛЯ УПРАВЛЕНИЯ ПРОМЫШЛЕННЫМ

РОБОТОМ

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

Известно устройство для управления промышленным роботом, содержащее счетчики, блок сравнения, блок памяти, сумматор и. блок управления (1).

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

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

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

15 механизма.

Цель изобретения — повышение точности устройства.

Указанная цель достигается тем, 2О что устройство содержит дополнительно коммутатор, последовательно соединенные первый ключ и двоичный счетчик, а также последовательно соединенные элемент ИЛИ, второй ключ и второй реверсивный счетчик, второй вход которого подключен к выходу первого ключа, а выходы - к первым входам коммутатора, выходом соединенного с четвертым входом сумматора, а вторым входом — с выходом двоичного счетчика, вторым входом второго клю970320 ча и первым входом первого ключа, второй вход которого подключен к вы ходу датчика положения, а входы элемента ИЛИ соединены с выходами блока управления.

На чертеже представлена функци- 5 ональная схема устройства для управления промышленным роботом.

Устройство содержит блок 1 обучения, блок 2 памяти, блок 3 управления, первый реверсивный счетчик 4, 10 сумматор 5, коммутатор 6, триггер 7, формирователь 8 импульса,.элемент 9 задержки, элемент ИЛИ 10, первый ключ 11, второй реверсивный счетчик

12, датчик 13 положения, второй ключ

14, двоичный счетчик 15, привод 16.

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

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

9 задержки. Он изменяет свое состояние только при изменении направления перемещения по данной координате.

Такой режим работы обеспечивает формирователь 8 импульса. Запись резуль-. тата суммирования в блок 2 по окончании цикла позиционирования в оче редной точке осуществляется по сигналу от блока 1 обучения. По этому сигналу результат перемещения рабочего органа, накопленный в первом реверсивном счетчике 4, передается 60 в сумматор 5, где в зависимости от наличия сигнала на выходе триггера 7 к этому результату может добавляться или не добавляться содержимое второго реверсивного счетчика 12.

Соответствие числа импульсов, поступающих от второго реверсивного счетчика 12 в сумматор 5, фактической величине люфта обеспечивается тем, что импульсы компенсации люфта через элемент ИЛИ 10 и второй ключ

14 накапливаются во втором реверсивном- счетчике 12 до тех пор, пока при позиционировании в данной точке не будет выбран люфт в механической передаче и на второй (вычитающий) вход реверсивного счетчика 12 не начнут поступать импульсы с датчика 13 положения через первый ключ 11. Те же импульсы датчика 13 положения затем поступают в двоичный счетчик 15, который своими выходами с момента поступления первого импульса запирает первый и второй ключи 11 и 14 и открывает коммутатор 6, разрешающий выдачу с второго реверсивного счетчика 12 накопленных импульсов. Это число соответствует фактической величине люфта данной оси координат в данной точке и в данное время. Разрядность двоичного счетчика 15 выбирается из условия максимально возможной величины люфта.

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

Применение изобретения позволяет повысить точность устройства.

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

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

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

Редактор И. Михеева Техред.М.Гергель Корректор Г. Огар

Заказ 8387/57 Тираж 914 Подписное

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

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

Филиал ППП Патент, г. Ужгород, ул. Проектная, 4 следовательно соединенные элемент ИЛИ, второй ключ и второй реверсивный счетчик, второй вход которого подключен к выходу первого ключа, а выходы — к первым входам коммутатора, выходом соединенного с четвертым входом сумматора, а вторым входом — с выходом двоичного счетчика, вторым входом второго ключа и первым входом первого ключа, второй вход которого подключен к выходу датчика положения, а входы элемента ИЛИ соеди- нены с выходами блока управления.

Источники информации, принятые во внимание при экспертизе

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

9 193266, кл. G 05 В 19/18, 1965.

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

Р 705421, кл. G 05 В 19/18, 1979 (прототип).