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

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

Иллюстрации

Показать все

Реферат

 

ОПИСАНИЕ

ИЗОБРЕТЕНИЯ

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

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

Республик

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (61) Доповнитепьное к авт. саид-ву (51)М. Кл.

{22) Заявлено 18. 03. 80 (21) 2895274/18-24 с присоединением заявки М (23) Приоритет

Опубликовано 15.1131. Бюллетень Йя 42

G 05 В 19/00

В 25 J 9/00

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

СССР по делам изобретений и открытий

4 (53) УДК,6 2-50,(088. 8 (71) Заявитель

Рыбинский авиационный технологический институт (54 ) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ АДАПТИВНЫМ РОБОТОМ

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

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

Однако устройство имеет узкие функциональные воэможности.

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

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

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

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

60

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

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

Устройство содержит блок 1 ввода изображения, блок 2 вычисления координат крайних точек, блок 3 вычисления размера проекции, блок 4 сравнения, коммутатор 5 команд, блок

6 памяти, дешифратор 7, блок 8 формирования сигналов перемещения,приводы 9, датчики 10 положения исполнительного органа, блок 11 управления, блок 12 формирования прямоуголь-, ного растра, коммутатор 13 разверток, сумматор 14.

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

Положение детали на рабочей поверхности определяется координатами ее центра тяжести Х, У и углом ориентации оси симметрии относительно некоторой линии отсчета. Вычисление координат положения детали на рабочей поверхности начинается с момента поступления импульса передачи управления иэ блока 8 формирования сигналов перемещения в блок 11 управления„

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

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

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

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

Под действием сигнала, поступающего из блока 11 управления на вход коммутатора 13 разверток, выходные сигналы блока 12 формирования прямоугольного растра через коммутатор

13 раэверток подаются на вход блока

1 ввода изображения. На выходе блока

1 ввода изображения появляется сигнал, логическое значение которого соответствует оптической информации, ;воздействующей на выбранный элемент информационного поля фотоприемной матрицы. На основании логических значений сигналов, поступающих с выхода блока 1 ввода изображения и с выхода блока 12 формирования прямоугольного растра, блок 3 вычисления координат крайних точек вычисляет координаты крайних точек положения объекта по оси Х. Затем значения координат крайних точек поступают на блок 3 вычисления размера проекции и сумматор 14. Сумматор 14 вычисляет значение координаты Хс центра тяжести детали. Блок вычисления размера проекций вычисляет размер проекций аХ„ детали по оси Х. После окончания вычисления координаты Хс и вычисления размера проекций по Х на вход блока

11 управления поступают сигналы, свидетельствующие об этом, и блок 11 управления через коммутатор 5 команд обеспечивает запись информации о координате Хс с выхода сумматора 14 в соответствующие ячейки блока 6 памяти, Значение размера проекции а Х записывается в блок 4 сравнения. После этого блок 11 управления переключает коммутатор 5 команд и коммутатор 13 разверток в режим определения координаты У и размера проекции ь У по оси

У. Значение Усчереэ коммутатор 5 команд заносится в блок 6 памяти. Затем в блок 4 сравнени через коммутатор

5 команд поступае, значение размера проекции А.У . По сигналу с блока 11 управления производится сравнение величин и Х1 и д Y „. Знак результата сравнения через коммутатор 5 команд заносится в соответствующую ячейку блока 6 памяти.

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

После определения Х, Уо и знака (IX -ЬУ„) коммутатор 5 команд вырабатывает сигнал, который подается на блок 11 управления. Блок 11 управления вырабатывает сигнал, по которому блок 8 формирования сигналов перемещения формирует сигнал на приводы 9 для поворота блока 1 ввода изображения на -" После получения

А, сигнала от блока 8 формирования сигД налов перемещения блоком 11 управления о том, что блок„1 ввода изображения развернут на — 1 блок 11

4 управления вырабатывает сигналы для вычисления Ь Х, ьУ у и нх сравнения.

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

15 последовательно соединенные блок вычисления координат крайних точек, блок вычисления размера проекции и блок сравнения, выход и второй вход ,которого подключены соответственно

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

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

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

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

Устройство для управления адаптивным роботом, содержащее последовательно соединенные коммутатор команд, блок памяти, блок формирования сигналов перемещения, приводы и датчики 40 положения исполнительного органа,выходы которых подключены ко вторым входам блока формирования сигналов перемещения, а также последовательно соединенные блок управления, блок формирования прямоугольного: растра, коммутатор разверток и блок ввода изображения, установленный на схваЗнак сравнения (Ь Х - ь Yg ) заносится в соответствующую ячейку блока б памяти через коммутатор 5 команд.

По сигналу с коммутатора 5 команд иэ блока б памяти информация о знаках (bX q - дУ„) и (ьХ - ь У1) поступает на вход дешифратора 7, На соответствующем выходе дешифратора 7 появляется сигнал, по которому блок

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

По сигналу с блока 11 управления производится вычисление координаты

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

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

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

В 470791, кл. G 05 В 15/00, 1976.

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

881669

Составитель Е. Политов

ТехредМ.Надь Корректор Г.Решетник

Редактор Е. Плисак

Заказ 9968/70, Тираж 943 Подписное

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

1$3Q!35 Москва, Ж-35, Раушская наб., д. 4/5!

» филиал ППП "Патент", г. ужгород, ул, Проектная,4