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

lр К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ ГОСУДАРСТВЕННЫЙ КОМИТЕТ СССРПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТНРЫТИЙ(71) Владимирский политехнический институт(54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРОМЫШЛЕННЫМ РОБОТОМ (57) Изобретение относится к области робототехники и может быть использовано при создании устройств для управления промышленными роботами, выполняющими операции с объектами, на которые положены внешние связи, например при выполнении операции шлифования. Цель изобретения - повышение надежности работы устройства. В изобретении в режиме управления по усилию за счет введения вентилей, блока выделения знака и коммутатора обеспечивается подача на привод сигналов рассогласования, совпадающих по знаку с сигналом задатчика усилия. Указанное исключает реверсирование привода при возникновении нагрузок больше заданных и переключение устройства на ре- Я жим управления по положению, 1 ил.Изобретение относится к робототехнике, может быть использовано при создании устройств управления промышленными роботами, выполняющими операции с объектами, на которые наложены внешние связи, например шлифование поверхностей сложной формы.Цель изобретения - повышение надежности работы устройства путем исключения реверсирования привода при возникновении нагрузок, превышающих заданные. 1 ОНа чертеже представлена функциональная схема устройства.Устройство содержит задатчик 1 положения, задатчик 2 усилия, первый и второй сумматоры 3 и 4 соответственно, первый и второй усилители 5 и 6 соответственно, коммутатор 7, сумматор 8, усилитель 9, привод 10, исполнительный механизм 11, датчик 12 скорости, датчик 13 положения, датчик 14 контакта, датчик 15 усилия, первый и второй вентили 16 и 1 соответственно, блок 18 выделения знака, второй коммутатор 19.Устройство работает следующим образом.С задатчика 1 положения поступает сигнал на отработку приводом 10 заданного перемещения исполнительного механизма 11, 25 содержащего силовой необратимый редуктор и схват, в котором может быть закреплена или шлифовальная головка, или обрабатываемая деталь в зависимости от грузоподъемности манипулятора и веса детали. Из этого сигнала в сумматоре 3 вычитается ЗО сигнал датчика 13 положения н подается усиленный усилителем 5 на первый вход коммутатора 7, а с его выхода -- на вход сумматора 4, где из него вычитается сигнал датчика 12 скорости. Полученный сигнал, усиленный усилителем 6, подается на привод 10 исполнительного механизма 11. Сигнал с датчика 14 контакта переключает в момент контакта шлифовального круга с поверхностью детали коммутатор 7 с контура управления по положению на контур управления по усилию. С данного момента сигнал с задатчика 2 усилия (резания), вычитая сигнал с датчика 15 в сумматоре 8, подается на входы вентилей 16 и 17, а с них - на первый и второй 45 входы второго коммутатора 19. Вентили 16 и 17 имеют различную проводимость (т, е. включены встречно), поэтому коммутатор 19 подключает к входу усилителя 9 тот из них, который имеет проводимость, соответствующую знаку сигнала задатчика 2. Осуществляется этом с помощью блока 18. Выходной сигнал блока 18 переключает второй коммутатор 19 на тот из входов, к которому подключен вентиль 16 или 17, соответствующий знаку сигнала с задатчика 2. Например, если сигнал задания положительный, подключается вентиль 16, имеющий проводимость в направлении от выхода сумматора 8 к входу коммутатора 19, если сигнал задания отриЦательный (предполагается, что сигнал задания силы резания может изменяться, что Имеет место при контурной обработке деталей), подключается вентиль 17, имеющий проводимость в направлении от входа коммутатора 19 к выходу сумматора 8.формула изобретенияУстройство для управления промышленным роботом, содержащее последовательно соединенные задатчик положения, первый сумматор, первый усилитель, первый коммутатор, второй сумматор, второй усилитель и привод, связанный с исполнительным механизмом, с которым кинематически связаны датчик положения, датчик скорости, датчик контакта и датчик усилия, выход которого подключен к первому входу третьего сумматора, соединенного вторым входом с выходом задатчика усилия, третий усилитель, выход которого подключен к второму входу первого коммутатора, соединенного третьим входом с выходом датчика контакта, выход,датчика скорости подключен к второму входу второго сумматора, а выход датчика положения соединен с вторым входом первого сумматора, отличающееся тем, что, с целью повышения надежности устройства, оно содержит два встречно включенных вентиля и последовательно соединенные блок выделения знака и второй коммутатор, выход которого подключен к входу третьего усилителя, а второй и третий входы - к выходам первого и второго вентилей соответственно, подключенных входами к выходу третьего сумматора, а вход блока выделения знака соединен с выходом задатчика усилия.Редактор М. НедолуженкоЗаказ 5560/47 Составитель Е. Политов Техред И. Верес Корректор Л. Обручар Тираж 836 Подписное ВНИИПИ Государственного комитета СССР по делам изобретений и открытий 113035, Москва, Ж - 35, Раушская наб., д, 4/5 Филиал ППП Патент, г. Ужгород, ул. Г 1 роектная, 4