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

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