Устройство для управления адаптив-НыХ РОбОТОМ Советский патент 1981 года по МПК G05B15/00 B25J13/00 

(54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ АДАПТИВНЫМ РОБОТОМ

тельно ограничивается сфера применения известного устройства.

Цель изобретения - расширение функциональных возможностей устройства.

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

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

Устройство содержит блок 1 ввода изображения, операционный блок 2, коммутатор 3 .команд, блок 4 памяти, блок 5 формирования сигналов перемешения, приводы 6, блок 7 датчиков положения, нуль-opraji 8, блок 9 круговой развертки, блок 10 управления, блок 1 1 формирования пря.моугольного растра; коммутатор 12 разверток, генератор 13, элемент 14 И,первый двоичный умножитель 15, второй двоичный у.множитель 16, первый счетчик 17, третий двоичный умножитель 18, второй счетчик 19.

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

Положение детали на рабочей поверхности определяется координатами ее центра тяжести Хс, УС и углом ориентации оси симметрии детали относительно некоторой линии отсчета. Вычисление координат положения детали на рабочей поверхности начинается с момента поступления импульса передачи управления из блока 5 формирования сигналов перемещения в блок 10 управления. При расположении блока 1 ввода изображения в схвате робота это свидетельствует о выходе схвата в центр заданной зоны обзора. Вычисление интересующих параметров осуществляется путем обработки оптической информации о положении детали в зоне обзора, формируемой блоком 1 ввода изображения. Чувствительным элементом блока 1 ввода изображения является фотоприемная матрица, на матричное фоточувствительное поле которой с помощью объектива проектируется изображение детали.

с началом ,работы устройства блок 10 управления запускает блок 11 формирования прямоугольного растра. Выходные сигналы блока 11 поступают на вход коммутатора 12 разверток. Под действием сигнала, поступающего из блока 10 управления на вход коммутатора 12 разверток, выходные сигналы блока 11 формирования прямоугольного растра через коммутатор 12 разверток подаются на вход блока 1 ввода изображения. На выходе блока 1 ввода изображения появляется сигнал, логическое значение которого соответствует оптической информации, воздействующей на выбранный элемент информационного поля фотоприемной матрицы. На основании логических

значений сигналов, поступающих с выхода блока 1 ввода изображения и с выхода блока 11 формирования прямоугольного растра, операционный блок 2 вычисляет значение координаты Хс центра тяжести, детали. После окончания вычисления координаты Xj

с выхода операционного блока 2 на вход блока 10 управления поступает сигнал, свидетельствующий об этом, и блок 10 управления через коммутатор 3 команд обеспечивает запись информации о координате Хс

с выхода операционного блока 2 в соответствующую ячейку блока 4 памяти. После этого блок ГО управления переключает коммутатор 3 команд и коммутатор 12 разверток в режим определения координаты У.. Вычисление и запись информации У в блок

0 4 памяти осуществляется аналогично Х..

После вычисления координат Х и У центра тяже,сти детали они должны быть отработаны Приводами 6 исполнительного органа робота. В результате отработки этих величин схват робота должен совместиться

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

0 происходить в системе координат манипулятора адаптивного робота. Плоские координаты схвата в цилиндрической системе координат определяются длиной руки и углом ее поворота. Поэтому для вывода схвата адаптивного робота над центром тяжести

5 детали в результате отработки вычисленных значений его координат Х и У необходимо преобразовать их в приращения длины ЛН и угла поворота Л А руки робота. Приближенные условия преобразования координат имеют вид

°&R cHYc

A(,

где С - коэффициент, учитывающий параметры оптической системы блока 1 ввода изображения;

5 Н и R - высота расположения схвата над рабочей поверхностью и длина руки адаптивного робота соответственно, фиксируемые блоком 7 датчиков положения исполнительного органа робота при вычислении координат Лс и УС центра тяжести детали. В соответствии с этим, для преобразования вычисленных значений координат Х и У( центра тяжести детали после записи координаты УС в соответствующую ячейку блока 4 памяти блок 10 управления открывает элемент 14 И, через который импульсы от генератора 13 поступают на второй двоичный умножитель 16. Второй двоичный умножитель 16 преобразует значение высоты, поступающее с первого выхода блока 7 датчиков положения, в поток одноразрядных приращений, поступающих на входы первого 15 и третьего 18 двоичных умножителей. На втором входе первого двоичного умножителя 15 образуется поток одноразрядных приращений, . соответствующий произведению высоты на ординату центра тяжести детали. Этот поток поступает в блок 5 формирования сигналов перемещения, в котором воспринимается как приращение длины руки адаптивного робота. Это приращение суммируется с уставкой длины руки, соответствующей центру зоны обзора. Одновременно на выходе третьего двоичного умножителя 18 образуется поток одноразрядных приращений, соответствующий произведению высоты на абсциссу центра тяжести детали. Это обеспечивается подачей вычисленной координаты Хс на второй вход третьего двоичного умножителя 18. Поток одноразрядных приращений с выхода третьего двоичного умножителя 18 поступает на вход второго счетчика 19, имеющего управляемый коэффициент деления. Изменение коэффициента деления второго счетчика 19 осуществляется кодом длины руки, поступающим со второго выхода блока 7 датчиков положения на второй вход второго счетчика 19.

В результате на выходе второго счетчика 19 образуется поток одноразрядных приращений, соответствующий частному от деления про 1зведения высоты и координаты Х центра тяжести детали на величину длины руки. Этот поток поступает в блок 5 формирования сигналов перемещения, в котором воспринимается как приращение угла поворота руки адаптивного робота. Это приращение суммируется с уставкой угла поворота руки, соответствующей центру зоны обзора. Потоки одноразрядных приращений на выходах второго счетчика 19 и первого двоичного умножителя 15 будут соответствовать необходимым величинам лищь при поступлении определенного количества импульсов на вход второго двоичного умножителя 16. Для обеспечения этого ко второму выходу второго двоичного умножителя 16, на котором вырабатываются импульсы переполнения, подключен первый счетчик 17. На выходе первого счетчика 17 появляется сигнал после поступления на вход второго двоичного умножителя 16 необходимого количества импульсов. По этому сигналу блок 10

управления закрывает элемент 14 И и выдает в блок 5 формирования сигналов перемещения команду на отработку полученных приращений длины и угла поворота руки адаптивного робота. В процессе отработки 5 этой информации приводами 6 исполнительного органа робота схват робота с установленным на нем блоком 1 ввода изображения перемещается в позицию, находящуюся над центром тяжести детали. В момент окончания отработки информации о центре тяжести детали, что фиксируется по совпадению информации, заданной на отработку, и информации, поступающей в блок 5 формирования сигналов перемещения с выхода блока 7 датчиков положения, из блока 5

5 формирования сигналов перемещения в блок 10 управления поступает импульс конца отработки. По этому сигналу блок 10 управления снова выдает команду на вычисление координат центра тяжести детали, что необходимо для компенсации погрешности отработки вычисленных в предыдущем цикле координат центра, вызванной приближенным характером реализуемых соотнощений, однако в каждом последующем цикле вычислений и отработки координат центра эта погрещность будет уменьщаться, стремясь к нулю. При определении в последующем цикле вычислений нулевых значений координат Хс и УС. центра тяжести детали срабатывает нуль-орган 8. Под действием сигнала, с выхода нуль-органа 8 блок 10 управления

0 включит режим определения угла ориентации детали.

В режиме определения угла ориентации блок 10 управления запускает блок 9 круговой развертки. Выходные сигналы блока 9 круговой развертки поступают на входы коммутатора 12 разверток. Управляющие сигналы, поступающие из блока 10 управления в режиме определения угла ориентации детали на вход коммутатора 12 разверток, обеспечивают прохождение сигналов с выхода блока

0 9 круговой развертки на выход коммутатора 12 разверток. Это обеспечивает форми- , рование дискретной круговой развертки вокруг центра тяжести детали. Одновременно на другом выходе блока 9 круговой развертки вырабатываются значения угловых расстоя5ний, разделяющих две соседние точки дискретной круговой развертки. На основании логических значений сигналов с выхода блока 1 ввода изображения, значений угловых расстояний с выхода блока 9 круговой развертки и управляющих сигналов с выхода блока 10 управления операционный блок 2 вычисляет значение угла ориентации. После окончания вычислений угла ориентации его значение с выхода операционного блока 2 с помощью коммутатора 3 команд по сигналу из блока 10 управления записывается в определенную ячейку блока 4 памяти. Затем блок 10 управления выдает в блок 5 формирования сигналов перемещения команду на прием вычисленного значения угла ориентации детали для отработки приводами 6 исполнительного органа робота. Вследствие соответствия систем координат при вычислении и отработке угла ориентации его значение передается в блок 5 формирования сигналов перемещения без промежуточного преобразова.ния. После разворота схвата робота на величину угла ориентации детали на вход блока 10 управления из блока 5 формирования сигналов перемещения поступает импульс конца отработки, по которому -повторяется цикл вычислений угла ориентации. Это необходимо для контроля соверщенного движения и повыщения помехоустойчивости устройства. При получении нулевого значения угла ориентации срабатывает нульорган 8 и блок управления 10 выдает в блок 5 формирования сигналов перемещения команду на. взятие детали.

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

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

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

второй двоичный умножитель, третий двоичный умножитель и второй счетчик, второй вход которого подключен ко второму выходу блока датчиков положения, а выход, - к шестому входу блока формирования сигналов перемещения, седьмой вход которого соединен с выходом первого двоичного умножителя, первый вход которого подключен к выходу второго двоичного умножителя, а второй вход - к второму выходу блока памяти, третий выход которого соединен со

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

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

1.Авторское свидетельство СССР № 477394, кл. G 05 В 15/00, 1977.

2.Авторские свидетельство СССР по заявке № 2528924/18-24, кл. В 25 J 9/00, 1978 (прототип).