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

 

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

СОЮЗ СОВЕТСКИХ

СОЦИАЛИСТИЧЕСКИХ

РЕСПУБЛИК (19) (Н ) (si>s B 25 J 13/00

ГОСУДАРСТВЕННЫЙ КОМИТЕТ

ПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМ

ПРИ ГКНТ СССР

ОПИСАНИЕ ИЗОБРЕТЕНИЯ

К АВТОРСКОМУ. СВИДЕТЕЛЬСТВУ (21) 4802176/08 (22) 12.03.90 (46) 15,06.92. Бюл. hh 22 (71) Томский институт автоматизированных систем и радиоэлектроники, Сибирский.физико-технический институт при Томском государственном университете (72) П.И. Нечунаев, C.ß. Пашнев, В.И..Сырямкин и А.А. Фомин (53) 62-229.78(088.8) (56) Ангелов M.ll., Сырямкин В.И. Телевизионная корреляционно-экстремальная сен-. сорная система для промышленных роботов. — Телевизионные вычислительные устройства, Томск, иэд-во Томского университета, вып. 4, 1981, с. 103 — 108. (54) УСТРОЙСТВО ДЛЯ ОПРЕДЕЛЕНИЯ

КООРДИНАТ ОБЪЕКТА МАНИПУЛИРОВАНИЯ В РАБОЧЕЙ ЗОНЕ. РОБОТА

Изобретение относится к машиностроеwe и может быть использовано при создании устройств, предназначенных для выработки зрительной информации робота:

Целью изобретения — повышение быстродействия работы устройства при одновременном повышении точности определения координат.

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

Первый и второй информационные выходы датчика 1 текущего изображения(ДТИ) подключены к первому и второму информационным входам экстраполятора 2 прямых (ЭП). Управляющий выход ДТИ 1 соединен с первым управляющим входом схемы 3 орга(57) Использование: при создании устройств, предназначенных для выработки зрительной информации робота. Сущность изобретения: в устройство, содержащее датчик текущего изображения, блок связи, накопитель информации, корреклятор, эталонное изображение, блок считывания, блок разверток, блок выделения максимума, блок оценки угловых координат, синхронизатор, механизм смены, дополнительно введены экстраполятор прямых, схема организации внутреннего цикла, вычислитель координат центра тяжести текущего изображения, вычислитель линейновозрастающей функции, блок оперативной памяти, вычислитель углов,. дополнительный накопитель информации, блок вычитания.

1 ил.

1 низации внутреннего цикла(СОВ Ц). Первый фь и второй информационные выходы ДТИ 1 подключены также к первому и второму информационным входам вычислителя 4 коор- Л динат центра тяжести изображения С (ВКЦТИ). Тактовый выход СОВЦ.3 подключен к отдеаьны м та кто аым входам дтИ т. Э П

2, ВКЦТИ 4, вычислителя 5 линейно-возра. стающей функции (ВЛВФ), блока 6 оперативной памяти (БОП), вычислителя 7 узлов (ВЧ. Блок 8 связи соединен с блоком 6. который соединен с дополнительным накопителем9 информации(ДНИ). Информационный выход СОВЦ 3 подключен к информационному входу ВЛВФ 5 и отдельному адресно1740150 му входу БОП 6. Первый управляющий выход СОВ Ц 3 подключен к первому управляющему входу ВКЦТИ 4 и отдельному управляющему входу синхронизатора 10, а второй управляющий выход СОВЦЗ вЂ” к вто- 5 рому управляющему входу ВКЦТИ 4, управляющему входу ВЛВФ 5, управляющему входу БОП 6 и управляющему входу ДНИ 9.

Первый информационный выход ЭП 2 соединен с информационным входом BY 7, а 10 второй информационный выход ЭП 2 — с информационным входом СОВЦ 3. Информационный выход BY 7 подключен к информационному входу ДНИ 9. Третий информационный вход ВКЦТИ4 соединен с 15 первым информационным выходом ВЛВФ

5, второй информационный выход которого подключен к первому информационному входу блока 11 вычитания (БВ). Информационный выход ДНИ 9 подключен к второму 20 информационному входу БВ 11, информационный выход которого соединен с информационным входом БОП 6, Первый управляющий выход синхронизатора 10 подключен к управляющему входу ДТИ 1 и 25 второму управляющему входу СОВЦ 3. Адресный выход синхронизатора 10 подключен к адресному входу блока 8 связи {БС) и отдельному адресному входу БОП 6, информационный выход которого соединен с ин- 30 формационным входом ВС 8. Два информационных выхода ВС 8 соединены с отдельными входами накопителя 12 информации (НИ), который оптически связан через коррелятор 13 с блоком 14 считывания 35 (БСЧ).

Информационный выход БСЧ подключен к информационному входу блока 15 выделения максимума (БВМ), управляющий выход которого соединен с управляющими 40 входами синхронизатора 10, блока 16 оценки угловых координат (БОУК) и механизма

17 смены (МС). Корелятор 13 механически связан с МС 17, управляющий выход которого соединен с вторым управляющим вхо- 45 дом синхронизатора 10, тактовый выход которого подключен к тактовому входу блока 18 разверток (БР). Четыре управляющих. входа БСЧ 14 соединены с четырьмя управляющими выходами БР 18, информацион- 50 ный выход которого подключен к информационному входу БОУК 16.

Второй и третий управляющие выходы синхронизатора 10 подключены соответственно к первому и второму управляющим 55 . входам БВМ 15, Первый и второй информационные выходы ВКЦТИ 4 являются первым и вторым информационными выходами устройства, в информационный выход БОУК 16 является третьим информационным выходом устройства, Устройство работает циклически. На очередном цикле работы устройства ДТИ 1 воспринимает иэображение участка сцены, выделяет иэображение объекта манипулирования (OM) и начинает слежение за его контуром. При этом по сигналу "Запуск", приходящему с синхронизатора 10, происходит сброс соответствующих счетчиков

ДТИ 1. С ДТИ 1 снимается сигнал "Готовность", свидетельствующий о начале слежения за контуром {появился видеосигнал определенной амплитуды). Синхронизация работы ДТИ 1 обеспечивается тактовым импульсом, поступающим на отдельный вход от СОВЦ 3. С ДТИ 1 снимаются сигналы Хь

Уь характеризующие положение 1-ro элемента контура изображения ОМ. Сигналы

Хь Yi поступают иа ВКЦТИ 4, работа которого описывается следующими выражениями где Xc, Yc — координаты центра "тяжести" изображения, ограничиваемого контуром, Хь У вЂ” координаты i-ro элемента контура в прямоугольной системе координат, связанной с ТИ (номера столбца и строки матрицы изображения), N — число элементов (дискретов) в контуре.

Сигнал, пропорциональный числу N, снимается с вычислителя линейно возрастающей функции 5.

При подходе считывающего луча ("ячейки") к краю изображения ОМ датчик 1 выдает сигнал готовности на СОВ Ц 3 и переходит в режим слежения с синхронизацией от

СОВЦ 3. Эта синхронизация осуществляется тактовыми импульсами. На выходе ДТИ 1 с каждым тактовым импульсом появляются координаты Хь Yi очередной точки контура, поступающие на зкстраполятор 2 прямых, который обеспечивает построение прямых линий. Работа экстраполятора 2 прямых описывается следующим выражением

Yn Y n+m

К (2) Х вЂ” Х +m где К вЂ” угловой коэффициент прямой линии;

Хп. Хп+в, Уп, Уп+в — координаты точек контура в прямоугольной системе координат, связанной с плоскостью накопителя информации; и — текущий элемент контура (текущий дискрет контура);

1 ч 1

Хс = Z(2Yi — 1), Ус = Х{2Х! — 1 ) (1)

2N. . 2N I=) 1740150

Р -агсЧ, +К К

Кг — K

1+К1Кг (3) m - постоянное число элементов (дискретов) контура.

Таким образом, экстраполятор 2 осуществляет следующие операции: запоминание координат Xn, Xn+m, Yn, Yn+m. точек контура; построение прямых линий, проведенных через точки с координатами Хп и Xn+m, Yn u

Ув+в.

С выхода экстраполятора 2 поступает на вычислитель 7 углов сигнал, пропорциональный коэффициенту наклона прямой. С выхода экстраполятора 2 сигналы, характеризующие начальные (исходные) координаты обхода контура, поступают также на СОВЦ3. Вычислитель 7 углов определяет угол между предыдущей и текущей прямыми линиями;- Работа вычислителя 7 узлов описывается следующим выражением где )% — угол между предыдущей и текущей прямыми линиями;

К1 и Кг — коэффициенты, определяемые по формуле (2), при этом К1 характеризует угловой коэффициент предыдущей прямой, а Кг — текущей прямой.

Сигнал, пропорциональный величине угла Р, поступает на дополнительный накопитель 9 информации, осуществляющий суммирование величин j3i следующим образом

j3{n ) = Х Рь (4) !

=1 где j3 (n ) — результирующая функция;

n — число углов Р.

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

Во время второго обхода контура GM иэображения вычислитель 5 линейно возрастающей функции строит линейно возрастающую функцию в следующем виде

К +1 l4+M, l = О, 1, 2..... М (5)

360

Для работы вычислителя 5 используется информация со СОВЦ 3 (сигнал, характеризующий номер элемента контура, сигнал

"Сброс" и тактовый импульс).

После этого блок 11 вычитания производит вычитание линейно возрастающей функции Ki+> (5) из результирующей функции

/3 (n ) (4). В результате этой операции на выходе блока 11 вычитания будет сигнал, характеризующий информативную часть

j3 (n ) результирующей функции Р (п ). Необходимость операции вычитания вызвана тем, что в процессе обхода контура на выходе дополнительного накопителя 9 информации формируется сигнал в виде дискретной функции, представляющей собой сумму линейно возрастающей функции и функции, характеризующей отклонения данной развертки контура изображения OM от развертки контура изображения круга. Последняя часть функции/3 (n ) является информационной, а функция Kl+> — неинформативной.

Таким образом, блок 11 вычитания осуществляет следующую операцию ф (и ) = j3(n ) — Кн-1. (6)

Сигнал, пропорциональный функции

j3 (n ), записывается в БОП 6. Операция "Запись" в БОП 6 осуществляется с помощью управляющих сигналов, поступающих с

СОВЦ 3 (тактовый и управляющий импульсы, сигнал, характеризующий номер элемента в контуре). Считывание информации о БОП 6 осуществляется по сигналу от СОВ Ц

3 по адресу от синхронизатора 10. При этом сигнал с БОП 6 (т.е. цифровой видеосигнал) поступает на блок 8 связи, осуществляющий формирование в накопителе 12 информации текущей реализации. В качестве накопителя 12 информации можно использовать различные ЗУ (например регистры или

ЗЭЛТ). С помощью коррелятора 13 формируется взаимнокорреляционная функция текущей реализации (т.е. текущее изображение (ТИ) и эталонной реализацией (т.е. эталонное изображение ЭИ), Причем эта-. лонная реализация выполнена в виде двух последовательно соединенных информативных частей результирующих функций

3 (n ), т.е.

j3 3 = /3 (n ) + j3 (n ). (7)

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

В качестве коррелятора 13 может быть использован модифицированный коррелятор Майера-Эпплера (оптический).

Блок 14 считывания с помощью блока 18 разверток обеспечивает считывание изо1740150 бражения ВКФ и выдачу на блок 45 выделения максимума видеосигнала, характеризующего ВКФ. Блок 15 выделения максимума, сравнивая текущий и последующий видеосигналы, выдает сигнал сравнения при равенстве (с допустимой точностью) входных видеосигналов. По сигналу сравнения БОУК

16 снимает с блока 18 разверток сигнал. характеризующий угловую координату ai.

Таким образом, угол а оценивается путем анализа следующего выражения

1 (а ) = jp (и )p (n + ф ) d ф. (8)

По сигналу сравнения с помощью механизма 17 смены осуществляется смена ЭИ.

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

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

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

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

40 блока связи, первым адресным входом, объединенным с соответствующим адресным входом блока связи, соединенным с соответствующим адресным выходом синхронизатора, а вторым адресным входом, 45 объединенным с информационным входом вычислителя, линейно возрастающей функции, соединенным с информационным выходом схемы организации внутреннего цикла, первым управляющим входом под50 клаченным к управляющему выходу датчика текущего изображения, а вторым управляющим входом, объединенным с управляющим входом датчика текущего иэо-, бражения и подключенным к первому

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

1740150

Составитель Н. Сергеев

Техред М.Моргентал Корректор С. Черни

Редактор И, Касарда

Заказ 2037 Тираж Подписное

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

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

Производственно-издательский комбинат "Патент", r. Ужгород, ул.Гагарина, 101 выходом механизма смены, отдельным управляющим входом, объединенным с указанным управляющим входом блока оценки угловых координат и с управляющим входом механизма смены, соединен- 5 ным с соответствующим управляющим выходом блока выделения максимума, вычислитель углов, информационный выход которого соединен с информационным входом дополнительного накопителя информации, причем информационный выход блока разверток соединен с информационным входом блока оценки угловых координат, информационный выход которого является третьим информационным выходом устройства.