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

ОЮЗ СОВЕТСКИХОЦИАЛИСТИЧЕСКИЕСПУБЛИК 9) (Н) 51)5 В 25,3 13/О ОСУДАРСТВЕННЫЙ КОМИТЕТ О ИЗОБРЕТЕНИЯМ И ОТКРЫТИПРИ ГКНТ СССР П ИСАН И Е ИЗС) БРЕТЕ Н И КОМУ. СВИДЕТЕЛЬС(57) Использование: при создании устройств, предназначенных для выработки зрительной информации робота. Сущность изобретения: в устройство, содержащее датчик текущего изображения, блок связи, . накопитель информации, корреклятор, эталонное изображение, блок считывания, блок разверток, блок выделения максимума, блок оценки угловых координат, синхронизатор, механизм смены, дополнительно введены экстраполятор прямых, схема организации внутреннего цикла, вычислитель координат центра тяжести текущего изображения, вычислитель линейновозрастающей функции, блок оперативной памяти, вычислитель углов,. дополнительный накопитель информации, блок вычитания, З 1 ил,низации внутреннего цикла(СОВ Ц). Первый и второй информационные выходы ДТИ 1 подключены также к первому и второму информационным входам вычислителя 4 координат центра тяжестиизображения (ВКЦТИ), Тактовый выход СОВЦ.3 подключен к отдельным тактовымвходам ДТИ 1, ЭП 2, ВКЦТИ 4, вычислителя 5 линейно-возра. стающей функции (ВЛВФ). блока 6 оперативной памяти (БОП), вычислителя 7 узлов (ВУ),Блок 8 сеярый соединенлем 9 информавыход СОВЦному входу В(71) Томский институт автоматизированныхсистем и радиоэлектроники, Сибирский.физико-технический институт при Томс)(ом государственном университете(54) УСТРОЙСТВО ДЛЯ ОПРЕДЕЛЕНИЯКООРДИНАТ ОБЪЕКТА МАНИПУЛИРОВАНИЯ В РАБОЧЕЙ ЗОНЕ РОБОТА Изобретение относится к машиностроению и может быть использовано при создании устройств, предназначенных для выработки зрительной информации робота:Целью изобретения - повышение быстродействия работы устройства при одновременном повышении точности определения координат,На чертеже приведена функциональная схема устройства.Первый и второй информационные выходы датчика 1 текущего изображения(ДТИ) подключены к первому и второму информационным входам экстраполятора 2 прямых (ЭП). Управляющий выход ДТИ 1 соединен с первым управляющим входом схемы 3 оргаэи соединен с блоком 6, котос дополнительным накопите- ции ЩНИ). Информационный 3 подключен к информацион- ЛВФ 5 и отдельному адресно 1740150+ му входу БОП 6. Первый управляющий выход СОВ Ц 3 подключен к первому управляющему входу ВКЦТИ 4 и отдельному управляющему входу синхронизатора 10, а второй управляющий выход СОВЦЗ - к вто рому управляющему входу ВКЦТИ 4, управляющему входу ВЛВФ 5, управляющему входу БОП 6 и управляющему входу ДНИ 9.Первый информационный выход ЭП 2 соединен с информационным входом ВУ 7, а 10 второй информационный выход ЭП 2 - с информационным входом СОВЦ 3. Информационный выход ВУ 7 подключен к информационному входу ДНИ 9, Третий информационный вход ВКЦТИ 4 соединен с 15 первым информационным выходом ВЛВФ 5, второй информационный выход которого подключен к первому информационному входу блока 11 вычитания (Б В). Информационный выход ДНИ 9 подключен к второму 20 . информационному входу БВ 11, информационный выход которого соединен с информационным входом БОП 6, Первый управляющий выход синхронизатора 10 подключен к управляющему входу ДТИ 1 и 25 второму управляющему входу СОВЦ 3, Адресный выход синхронизатора 10 подключен к адресному входу блока 8 связи (БС) и отдельному адресному входу БОП 6, информационный выход которого соединен с ин формационным входом ВС 8, Два информационных выхода ВС 8 соединены с отдельными входами накопителя 12 информации (НИ), который оптически связан через коррелятор 13 с блоком 14 считывания 35 (БСЧ).Информационный выход БСЧ подключен к информационному входу блока 15 выделения максимума (БВМ), управляющий выход которого соединен с управляющими 40 входами синхронизатора 10, блока 16 оценки угловых координат (БОУК) и механизма 17 смены (МС), Корелятор 13 механически связан с МС 17, управляющий выход которого соединен с вторым управляющим вхо дом синхронизатора 10, тактовый выход которого подключен к тактовому входу блока 18 разверток (БР). Четыре управляющих входа БСЧ 14 соединены с четырьмя управляющими выходами БР 18, информацион ный выход которого подключен к информационному входу БОУК 16.Второй и третий управляющие выходысинхронизатора 10 подключены соответственно к первому и второму управляющим 55 . входам БВМ 15, Первый и второй информационные выходы ВКЦТИ 4 являются первым и вторым информационными выходами устройства, в информационный выход БОУК 16 является третьим информационным выходом устройства,Устройство работает циклически. На очередном цикле работы устройства ДТИ 1 воспринимает иэображение участка сцены, выделяет иэображение объекта манипулирования (ОМ) и начинает слежение за его контуром. При этом по сигналу "Запуск", приходящему с синхронизатора 10, происходит сброс соответствующих счетчиков ДТИ 1. С ДТИ 1 снимается сигнал "Готовность", свидетельствующий о начале слежения за контуром (появился видеосигнал определенной амплитуды). Синхронизация работы ДТИ 1 обеспечивается тактовым импульсом, поступающим на отдельный вход от СОВЦ 3. С ДТИ 1 снимаются сигналы Хь Уь характеризующие положение 1-го элемента контура изображения ОМ. Сигналы Хь У поступают иа ВКЦТИ 4, работа которого описывается следующими выражениями где Хс, Ус - координаты центра "тяжести" изображения, ограничиваемого контуром,Хь У - координаты 1-го элемента контура в прямоугольной системе координат, связанной с ТИ (номера столбца и строки матрицы изображения),Й - число элементов (дискретов) в контуре.Сигнал, пропорциональный числу й, снимается с вычислителя линейно возрастающей функции 5.При подходе считывающего луча ("ячейки") к краю изображения ОМ датчик 1 выдаетсигнал готовности на СОВЦ 3 и переходит в режим слежения с синхронизацией от СОВЦ 3. Эта синхронизация осуществляется тактовыми импульсами. На выходе ДТИ 1 с каждым тактовым импульсом появляются координаты Хь У очередной точки контура, поступающие на зкстраполятор 2 прямых, который обеспечивает построение прямых линий. Работа экстраполятора 2 прямых описывается следующим выражением где К - угловой коэффициент прямой линии;Хл. Хо+в, Уп, Уп+в - координаты точек контура в прямоугольной системе координат, связанной с плоскостью накопителя информации;и - текущий элемент контура (текущий дискрет контура);(3) гп -постоянное число элементов (дискретов) контура,Таким образом, экстраполятор 2 осуществляет следующие операции: запоминание координат Хп, Хо+П 1, Уо, Уп+а, точек контура; построение прямых линий, проведенных через точки с координатами Хп и Хп+в, Уп и Уо+в.С выхода экстраполятора 2 поступает на вычислитель 7 углов сигнал, пропорциональный коэффициенту наклона прямой. С выхода экстраполятора 2 сигналы, характеризующие начальные (исходные) координаты обхода контура, поступают также на СОВЦ 3. Вычислитель 7 углов определяет угол между предыдущей и текущей прямыми линиями; Работа вычислителя 7 узлов описывается следующим выражени- ем где % - угол между предыдущей и текущей прямыми линиями;К 1 и Кг - коэффициенты, определяемые по формуле (2), при этом К 1 характеризует угловой коэффициент предыдущей прямой, а Кг - текущей прямой.Сигнал, пропорциональный величине угла ф, поступает на дополнительный накопитель 9 информации, осуществляющий суммирование величин 3 следующим образомф(П) = Х У%, (4)1=1 где р (п) - результирующая функция;и - число углов ф.На выходе накопителя 9 в процессе обхода формируется дискретный сигнал, описывающий круговойобход контура и пропорциональный функции, представляющей собой сумму линейно возрастающей функции и функции, характеризующей отклонения данного изображения контура ОМ от иэображения контура круга.Вовремя второго обхода контура ОМ иэображения вычислитель 5 линейно возрастабщей функции строит линейно возрастающую функцию в следующем виде Кн 1 К+М, 1 = О, 1, 2, , М (5)360 Для работы вычислителя 5 используется информация со СОВЦ 3 (сигнал, характериЗующий номер элемента контура, сигнал "Сброс" и тактовый импульс). 5 10 15 20 25 30 35 40 45 50 55 После этого блок 11 вычитания производит вычитание линейно возрастающей функции К+1 (5) из результирующей функции /3 (и) (4). В результате этой операции на выходе блока 11 вычитания будет сигнал, характеризующий информативную часть р(и) результирующей функции р(п). Необходимость операции вычитания вызвана тем, что в процессе обхода контура на выходе дополнительного накопителя 9 информации формируется сигнал в виде дискретной функции, представляющей собой сумму линейно возрастающей функции и функции, характеризующей отклонения данной развертки контура изображения ОМ от развертки контура изображения круга, Последняя часть функцииф (и) является информационной, а функция К+1 - неинформативной.Таким образом, блок 11 вычитания осуществляет следующую операциюф (и) = 3(п) - Кн 1. (6) Сигнал, пропорциональный функции ф(п), записывается в БОП 6. Операция "Запись" в БОП б осуществляется с помощью управляющих сигналов, поступающих с СОВЦ 3 (тактовый и управляющий импульсы, сигнал, характеризующий номер элемента в контуре). Считывание информации о БОП 6 осуществляется по сигналу от СОВ Ц 3 по адресу от синхронизатора 10, При этом сигнал с БОП б (т,е. цифровой видеосигнал) поступает на блок 8 связи, осуществляющий формирование в накопителе 12 информации текущей реализации. В качестве накопителя 12 информации можно использовать различные ЗУ (например регистры или ЗЭЛТ). С помощью коррелятора 13 формируется взаимнокорреляционная функция текущей реализации (т.е. текущее изображение (ТИ) и эталонной реализацией (т.е, эталонное изображение ЭИ), Причем эта-. лонная реализация выполнена в виде двух последовательно соединенных информативных частей результирующих функций 3 (и), т.е.Рз = Р(и) + ф(п). (7) Применение ЭИ в таком виде обеспечивает представление дополнительной информации, необходимой для правильной оценки угла а (т.е, оценки смещения текущей реализации относительно эталонной реализации). ЭИ выполнено в виде оптического изображения (например позитив фотографии).В качестве коррелятора 13 может быть использован модифицированный коррелятор Майера-Эпплера (оптический).Блок 14 считывания с помощью блока 18 разверток обеспечивает считывание изображения ВКФ и выдачу на блок 45 выделения максимума видеосигнала, характеризующего ВКФ. Блок 15 выделения максимума, сравнивая текущий и последующий видеосигналы, выдает сигнал сравнения при равенстве (с допустимой точностью) входных видеосигналов. По сигналу сравнения БОУК 16 снимает с блока 18 разверток сигнал, характеризующий угловую координату а.Таким образом, угол а) оценивается путем анализа следующего выражения По сигналу сравнения с помощью механизма 17 смены осуществляется смена ЭИ. На этом один цикл работы устройства заканчивается, Следующий цикл начинается по сигналу от синхронизатора 10.Формула изобретения Устройство для определения координат объекта манипулирования в рабочей зоне робота, содержащее датчик текущего изображения, блок связи, двумя информационными выходами соединенный с двумя информационными входами накопителя информации, оптически связанного с коррелятором, который оптически связан с блоком считывания, четырьмя управляющими входами соединенным с четырьмя управляющими выходами блока разверток, а информационным выходом соединенный с информационным входом блока выделения максимума, соединенного управляющим выходом с управляющим входом блока оценки угловых координат, синхронизатор, тактовым выходом соединенный с тактовым входом блока разверток, а адресным выходом - с первым адресным входом блока связи, механизм смены, механически связанный с коррелятором, о т л и ч а ю щ е е с я тем, что, с целью повышения быстродействия в работе устройства при одновременном повышении точности определения координат, в него дополнительно введены экстраполятор прямых, первым информационным выходом подключенный к информационному входу вычислителя углов, а вторым информационным выходом подключенный к информационному входу схемы организации внутреннего цикла, тактовым выходом соединенной с отдельными тактовыми входами экстрэполятора прямых, вычислителя линейно возрастающей функции, блока оперативной памяти, вычислителя углов, дополнительного накопителя информации, вычислителя координат центра тяжести текущего изображения и датчика текущего изображения, первым информационным выходом подключенного к первому информационному входу экстраполятора прямых и первому информационному входу вычислителя координат центра тя жести текущего изображения, а вторыминформационным выходом - к второму информационному входу экстраполятора прямых и второму информационному входу вычислителя координат центра тяжести те кущего иэображения, третий информацион-ный вход которого соединен с первым информационным выходом вычислителя линейно возрастающей функции, а первый управляющий вход, объединенный с .15 отдельным управляющим входом синхронизатора, соединен с первым управляющим выходом схемы. организации внутрейнего цикла, э второй управляющий вход, объединенный с управляющим входом вычислите ля линейно возрастающей функции,управляющим входом дополнительного накопителя информации, управляющим входом блока оперативной памяти, соединен с вторым управляющим выходом схемы орга низации внутреннего цикла, причем первыйи второй информационные выходы вычислителя координат центра, тяжести текущего изображения являются первым и вторым информационными выходами устройства, 30 блок вычитания, первым и вторым информационными входами подключенный соответственно к второму информационному.выходу вычислителя линейно возрастающей функции и к информационному выходу до полнительного накопителя информации, аинформационным выходом подключенный к информационному входу блока оперативной памяти, информационным выходом соединенного с информационным входом 40 блока связи, первым адресным входом, объединенным с соответствующим адресным входом блока связи, соединенным с соответствующим адресным выходом синхронизатора, а вторым адресным входом, 45 объединенным с информационным входомвычислителя, линейно возрастающей функции, соединенным с информационным выходом схемы организации внутреннего цикла, первым управляющим входом под ключенным к управляющему выходу датчика текущего изображения, а вторым управляющим входом, объединенным с управляющим входом датчика текущего иэо-, бражения и подключенным к первому 55 управляющему выходу синхронизатора,вторым и третьим управляющими выходами, соединенного соответственно с первым и вторым управляющими входами блока выделения максимума, отдельным управляющим входом соединенного с управляющим10 1740150 Составитель Н. СергеевРедактор И, Касарда Техред М.Моргентал Корректор С. Черни Тираж Подписноесударственного комитета по изобретениям и открытиям при ГКНТ ССС113035, Москва, Ж, Раушская наб., 4/5 Заказ 2037 ВНИИПизводственно-издательский комбинат "Патент", г. Ужгород, ул.Гагарина, 10 выходом механизма смены, отдельным управляющим входом, объединенным с указанным управляющим входом блока оценки угловых координат и с управляющим входом механизма смены, соединен ным с соответствующим управляющим выходом блока выделения максимума, вычислитель углов, информационный выход которого соединен с информационным входом дополнительного накопителя информации, причем информационный выход блошка разверток соединен с информационным входом блока оценки угловых координат, информационный выход которого является третьим информационным выходом устройства.