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

,ЯО, 1151924 4 Ш 6 05 В 1100 ОПИСАНИЕ ИЗОБРЕТЕНИЯ К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ ГОСУДАРСТВЕННЫЙ КОМИТЕТ СССРпо делАм изОБРетений и ОткРытий(71) Владимирский политехнический институт(56) 1. Авторское свидетельство СССР930228, кл, б 05 В 11/00, 1980.2. Авторское свидетельство СССР по заявке3368099/18 - 24, кл. б 05 В 11/00, 1981 (прототип).(54) (57) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ СБОРОЧНЫМ РОБОТОМ, содержацее задатчик скорости и задатчик усилия, выход которого соединен с первым входом первого сумматора, подключенного вторым входом к выходу датчика усилия, а также последовательно соединенные второй сумматор, блок управления и привод, кинематически связанный через исполнительный механизм с датчиком усилия и датчиком скорости, выход которого подключен к первому входу второго сумматора, отличающееся тем, что, с целью улучшения динамических характеристик устройства, оно содержит последовательно соединенные нелинейный элемент, интегратор и блок умножения, второй вход которого подключен к выходу задатчика скорости, выход - к второму входу второго сумматора, а вход нелинейного элемента соединен с выходом первого сумматора. фО1151924 Сос га в и тель Е. Пол нто в Редактор В. Иванова Те ред И. Верее Корректор О. Тигор За каз 2322/36 Тнраж 863 Подписное ВНИИПИ Гос .:,прственного комитета СССР по делам изобретений и открытий 113035, Москва, Ж - 35, Раушская наб., д. 4/5 Филиал ППП Патент, г, Ужгород, ул. Проектная, 4Изобретение относится к робототехнике и может бытьиспользовано при сборочных роботах, осуществляющих операции сопряжения деталей.Известно устройство для управления сборочным роботом содержащее задатчики усилия и скорости, сумматоры, усилители, коммутатор, блок коррекции, привод, исполнительный механизм и датчики скорости, положения и контакта 11.Однако данное устройство не ограничивает скорость переме 1 цения исполнительного органа робота при его контакте с предметом.Наиболее близким техническим решением к изобретению является устройство, содержащее задатчик скорости и задатчик усилия, выход которого соединен с первым входом первого сумматора, подключенного вторым входом к выходу датчика усилия, а также последовательно соединенные второй сумматор, блок управления и привод, кинематически связанный через исполнительный механизм с датчиком усилия и датчиком скорости, выход которого подключен к первому входу второго сумматора 12).Недостатком известного устройства является низкое быстродействие при сопряжении деталей с изменяющимся усилием сопряжения, что обусловлено автоколебательным режимом работы привода исполнительного органа. При этом привод работает в старт-стопном режиме.Целью изобретения является улучшение динамических характеристик устройства.Цель достигается тем, что в устройство, содержащее задатчик скорости и задатчик усилия, выход которого соединен с первым входом первого сумматора, подключенного вторым входом к выходу датчика усилия, а также последовательно соединенные второй сумматор, блок управления и привод, кинематически связанный . грез исполнительный механизм с датчиком усилия и датчиком скорости, выход которого подключен к первому входу второго сумматора, дополнительно введены последовательно соединенные нелинейный элемент, интегратор и блок умножения, второй вход которого подключен к выходу задатчика скорости, выход - к второму входу второго сумматора а вход нелинейного элемента соединен с выходом первого сумматора.На чертеже представлена функциональная схема устройства.Устройство содержит задатчик 1 усилия, первый сумматор 2, задатчик 3 скорости, блок 4 умножения, второй сумматор 5, блок 6 управления, привод 7, исполнитель 5 10 15 20 25 30 35 40 45 50 ный механизм 8, датчик 9 усилия, датчик 10 скорости, нелинейный элемент 11, интегратор 12.Устройство работает следующим образом.Задатчики 1 и 3 усилия и скорости формируют соответствующие сигналы усилия и скорости сопряжения деталей. Привод 7 перемещает исполнительный механизм 8.Когда фактическое усилие сборки равно заданному с точностью до величины, определяемой зоной нечувствительности элемента 11, отработка идет с заданной скоростью, Элемент 1 с зоной нечувствительности определяет требуемую точность поддержания момента и, кроме того, служит для фильтрации небольших пульсаций момента сопротивления нагрузки, всегда имеющих место. Если усилие сборки становится больше заданного, то на выходе сумматора 2 работающего в режиме вычитания из заданного момента блоком 1 фактического с датчика 9, появляется отрицательный сигнал. Когда он превышает величину зоны нечувствительности элемента 11, начинается его интегрирование. Выходной сигнал интегратора 12 подается на второй вход блока 4, вызывая уменьшение коэффициента передачи сигнала задания скорости сборки. Скорость процесса сборки уменьшается, При равенстве моментов задания и фактического с точностью до величины зоны нечувствительности элемента 11 интегрирование прекращается, однако, при этом по цепи задания скорости остается уменьшенный коэффициент передачи сигнала скорости, Если при сопряжении момент сборки меньше заданного, то на выходе сумматора 2 сигнал положительный, и интегратор 12 устанавливает больший коэффициент передачи сигнала задания скорости, Таким образом, цепь из элементов 2, 11 и 12 уменьшает сигнал задания скорости сборки, если усилие сборки превышает расчетное значение, и увеличивает скорость сборки, если усилие сборки меньше расчетного значения. Варьируемое значение коэффициента передачи блока произведения О - К. Это обеспечивает увеличение скорости сопряжения (как правило, К=1,2 - 2,0) и уменьшение ее до О (полный останов) в случае значительного превьппения сверх заданного усилия сборки. Блок 6 содержит необходимые усилительные, корректирующие и преобразовательные элементы.Применение изобретения позволит повысить плавность изменения скорости привода и исключает работу привода в стартстопном режиме,