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

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

Иллюстрации

Показать все

Реферат

 

OHNCanve

N3OSV r S

К АВТОРСКОМУ СВИ ИТИЯЬСТВУ

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

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

Республик (is>883867 (61) Дополнительное к авт. сеид-ву 9 704775 (22) Заявлено 03. 05. 79 (21) 2770140/18;24 с присоединением заявки ¹ (23) Приоритет

Опубликовано 23.1181. Бюллетень ИЯ 43

Дата опубликования описания 23. 11. 81 (51) М. Кд.

G 05 В 19/00

В 25 g 9/00

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

СССР по делам изобретений и открытий (53) УДК 62-50 (088. 8) М.A. Гладштейн, В. М ..Комаров, В:. В. Маляги н, 1

О.Т. Сахаров и С.M. Гуревич 1 .„;;., 1". (72) Авторы изобретения (71) Заявитель (54 ) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ АДАПТИВН61М РОБОТОМ

Изобретение относится к робототехнике и может быть использовано для управления адаптивным промышленным роботом при автоматиэапии производственных процессов.

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

2 входом блока управления, второй вход которого соединен со вторым выходом блока формирования сигналов перемещения, третий вход — с выходом нульоргана, второй выход. — с третьим входом блока, формирования сигналов перемещения, третий выход — со вторым входом коммутатора команд, четвертый выход — с третьим входом операционного блока, пятый выход — co входом блока круговой развертки, а шестой выход — с третьим входом коммутатора разверток (1) .

Недостатком известного устройства

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

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

Поставленная цель достигается

30 тем, что усТроАсТао содержит сумматор

883867

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

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

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

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

Положение деталей на рабочей поверхности определяется координатами их центров тяжести Х,Ч и углами ориентации осей симметрии деталей относительно некоторой линии отсчета.

Ь некоторый момент времени манипулятор может обеспечивать захват лишь одной детали. В соответствии с этим, для ее захвата устройство обеспечивает вычисление координат центра тяжести и угла ориентации. Для этого необходимо селектировать изображение этой детали из группового изображения деталей. Процесс селекции изображения одной детали, из группового изображения деталей, начинается с момента поступления импульса передачи управления из блока 5 формирования сигналов перемещения в блок 10 управления.

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

С началом работы устройства блок

10 запускает блок 11 формирования прямоугольного растра. Выходные сигналы блока 11 поступают на вхОд коммутатора 12 разверток.

Под действием сигнала, поступающего из блока 10 на вход коммутатора

12, выходные сигналы блока 11 через коммутатор 12 подаются,на вход блока 1. Это обеспечивает последовательный построчный выбор элементов информационного поля фотоприемной матрицы для анализа оптической инфоргла- . ции, воздействующей на них. Значения оптической информации; воздействующей

20 на элементы некоторой строки информационного поля матрицы, записываются в сдвигающий регистр 15. Если кадр изображения имеет m X и элементов разложения, где m — количество

25 строк разложения, à n — количество элементов разложения в строке, то сдвигающий регистр имеет емкость в и разрядов.

В конце каждой текущей строки информационного поля матрицы оптическая информация, накопленная в сдвигающем регистре 15, переписывается в предыдущую строку информационного поля второго блока 16 памяти, емкость которого составляет

m y и бит. Запись информации в предыдущую строку информационного поля второго блока 16 памяти обеспечивается с помощью сумматора 13, осуще— ствляющего в процессе селекции вычи-4О тание единицы из кода, поступающего с выхода коммутатора 12 разверток на вход блока 1.

Последовательный ввод нулевой оптической информации в сдвигающий

45 регистр 15 в процессе анализа кадра изображения осуществляется до появления первого видеосигнала, равного логической единице, что соответствует появлению некоторой детали по .текущей строке информационного поля фотоприемной матрицы. После этого осуществляется формирование изображения этой детали на данной строке. Блок 10 управления выделяет. момент окончания изображения детали по строке и вырабатывает сигнал, запираюций элемент И 14, до окончания текущей строки сканирования.Это обеспечивает запись в сдвигающий регистр 15 значений оптической инбО формации, равным логическому нулю, .независимо от наличия других деталей на этой строке. При анализе следующей строки информационного поля матрицы блок 10 открывает элемент И 14.

883867

Аналогично рассмотренному,обеспечивается прием логических значений оптической информации на этой строке в сдвигающий регистр 15, При этом в блоке 10 осуществляется сравнение логических значений оптической информации, воздействовавших на соответствующие элементы предыдущей строки информационного поля матрицы, поступающих с информационного поля второго блока 16 с логическими значениями оптической информации,воздействующих на соответствующие элемен ты текущей строки информационного поля матрицы. Последовательная соответствующая выборка квантованного видеосигнала из второго блока 16 памяти осуществляется с помощью селектора-мультиплексора 17, управляемого параллельно с блоком 1 кодами, поступающими с выхода коммутатора 12 разверток и определяющими выбор эле-: 20 мента на строке информационного поля матрицы.

Изображение детали на предыдущей строке информационного поля матрицы, извлекаемое из второго блока 16 памяти устанавливает границы изображения детали, селекция изображения .которой уже начата. Таким образом,в результате сравнения видеосигналов ЗО из второго блока 16 памяти и блока 1 ввода изображения определяется принадлежностью некоторого изображения на текущей строке, к изображению селектируемой детали. Если изображения каких-то деталей на текущей строке информационного поля матрицы не попадают в границы, установленные по предыдущей строке, то это изображение не является изображением селектируемой детали и по его 4О окончанию блок 10 управления осуществляет сброс сдвигающего регистра

15. Если же изображение детали-, формируемое блоком 1 на текур ей строке, находится в пределах установленных границ, то после его окончания на данной строке блок 10 управления закрывает элемент И 14, что соответствует заполнению до конца строки нулевой видеоинформацией сдвигающего регистра 15.

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

Если одно из изображений деталей на текущей строке информационного поля матрицы не попадает в установленные ЬО границы, то это означает, что селекция изображения данной детали закончена и блок 10 управления запирает элемент И 14 до конца кадра сканирования, что соответствует дальнейшему заполнению второго блока 16 памяти логическими значениями оптической информации, соответствующими отсутствию изображения деталей.

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

Для этого по окончании процесса селекции изображения одной детали блок 10 управления переводит устройство в режим вычисления координат центра тяжести детали. При этом сигналом с выхода блока 10 блокируется запись информации во второй блок 16 и вычитание единицы, выполняемое сумматором 13 в режиме селекции. Это обесцечивает сохранность селектированного изображения детали во втором блоке 16 памяти и синхронный выбор его элементов в процессе вычисления координат центра тяжести детали.

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

На основании логических значений сигналов поступающих через селектормультиплексор 17 с выхода второго блока 16 памяти и с выхода блока 11, операционный. блок 2 Вычисляет значение координат центра тяжести селектированной детали.

По окончании вычисления координаты Хс с выхода операционного блока

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

3 команд обеспечивает запись информации о координате селектированной детали с выхода операционного блока

2 в соответствующую ячейку блока 4 памяти. После этого блок 10 переключает коммутатор 3 команд и коммутатор 12 разверток в режим определения 9q. Вычисление и запись. информации об 9 в блок 4 памяти осуществляется аналогично Хс . После вычисления координат центра тяжести блок управления 10 выцает в блок формирования сигналов перемещения 5 команду на отработку полученной инфор-. мации.

В процессе отработки этой информации схват робота с установленным

883867

t0

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

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

8 блок 10 включает устройство в режим определения угла ориентации детали.

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

На основании логических значений сигналов с выхода второго блока 16 памяти, поступающих через селектормультиплексор 17, значений углов расстояний, с выхода блока 9 и управляющих сигналов с выхода блока

10, операционный блок 2 вычисляет значение угла ориентации селектированной детали.

После окончания вычислений угла ориентации его значение с выхода операционного блока 2 с помощью коммутатора 3 команд по сигналу из блока 10 записывается в определенную ячейку блока 4 памяти. Затем блок 10 выдает в блок 5 команду на отработку полученной информации..

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

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

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

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

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

rio заявке Р 2528924/18-24, кл. G 05 В 19/00, В 25 J 9/00,1977 (прототип);

883867

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

Техред Т.Маточка Корректор H. Швыдкая

Редактор Н. Рогулич

Тираж 943 Подписное

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

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

Заказ 10230/72 филиал ППП "Патент", r. Ужгород, ул. Проектная,4