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

 

УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ АДАПТИВНЫМ РОБОТОМ, содержащее источник излучения, оптически связанный с первым и вторым фотрдатчикамн , последовательно соединенные датчик скорости и элемент И, а также первый элемент ЗАПРЕТ, реверсивный счетчик и три триггера, о т л и ч аю щ е е с я тем, что, с целью упрощения и повышения надежности устройства , оно содержит второй и третий элементы ЗАПРЕТ и последовательно соединенные четвертый триггер и четвертый элемент ЗАПРЕТ, ввгход которого подключен к первому выходу устройства , второй вход - к выходу тре ,тьего триггера, а третий вход - к первому входу первого, второго и третьего элементов ЗАПРЕТ и выходу элемента И, соединенного вторым входом с выходом второго триггера, первый вход которого подключен ко второму входу первого элемента ЗАПРЕТ, первому входу первого триггера и шлходу первого фотодатчика, а второй вход - ко второму выходу устройства, выходу и первому входу реверсивного счетчика и первому входу четвертого триггера, соединенного вторвлм входом с выходом BTopoio фотодатчика, вторым входом третьего элемента ЗАПРЕТ и первым входом третьего (Л триггера, второй вход которого подключен к выходу третьего элемента с ЗАПРЕТ, выход первого элемента ЗАПРЕТ соединен со вторым входом первого триггера, подключенного выходом ко второму входу второго элекюнта ЗАПРЕТ, выход которого соединен со вторым входом реверсивного счетчика. го о О1

. COIO3 СОВЕТСНИХ

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

РЕСПУБЛИН

ЗСЮ G 05 В ll/ОО

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

ПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТНРЫТИЙ (21) 3545363/24-24 (22) 30.12 ° 82 (46) 30.10.84 Бюл. М 40 (72) A.Ã.Áåëîâ (71) Дальневосточный ордена Трудового Красного Знамени политехнический институт нм. В.В.Куйбышева .(53) 62-50 (088.8) (56) 1,.Авторское свидетельство СССР

i9 1004972, кл, G 05 В 15/00, 1981 °

2.Авторское свидетельство СССР по заявке и 3509928/24-24, кл. G 05 B ll/00, 1982 (прототип). (54)(57) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ

АДАПТИВНЫМ РОБОТОМ, содержащее источник излучения, оптически связанный с первым и вторым фотодатчиками, последовательно соединенные датчик скорости и элемент И, а также первый элемент ЗАПРЕТ, реверсивный счетчик и три триггера, о т л и ч аю щ е е с я тем, что, с целью упрощения и повышения надежности устройства, оно содержит второй и третий элементы ЗАПРЕТ и последовательно соединенные четвертый триггер и четВертай элемент ЗАПРЕТ, выход которо,Я0„„1 121645 А

ro подключен к первому выходу устройства, второй вход — к выходу третьего триггера, а третий вход — к первому входу первого, второго и третьего элементов ЗАПРЕТ и выходу элемента И, соединенного вторым входом с выходом второго триггера„ первый вход которого подключен ко второму входу первого элемента ЗАПРЕТ, первому входу первого триггера и выходу первого фотодатчика, а второй вход — ко второму выходу устройства, выходу и первому входу реверсивного счетчика н первому входу четвертого триггера, соединенного вторым входом с выходом второго фотодатчика, вторым входом третьего элемента Я

ЗАПРЕТ и первым входом третьего триггера, второй вход которого подключен к выходу третьего элемента

ЗАПРЕТ, выход первого элемента

ЗАПРЕТ соединен со вторым входом первого триггера, подключенного выходом ко второму входу второго зле1:: мента ЗАПРЕТ, выход которого соеди- ®Ф. нен со вторым входом реверсивного счетчика.

1121645

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

Известны устройства для управления адаптивными роботами, содержа5 щие датчик скорости конвейера, два фотодатчика, источник излучения, реверсивный счетчик, триггеры, элемента И, ИДИ, НЕ Ll 3.

Данное устройство обеспечивает совмещение центра схвата и с центра ми только круглых предметов.

Наиболее близким теХническим решением к изобретению является устройство, содержащее источник излучения, 15 оптически связанный с первым и вторым фотодатчиком, последовательно соединенные датчик скорости конвейера и элемент И, первый элемент ЗАПРЕТ реверсивный счетчик и трн триггера (2). 2О

Недостатком этого устройства является его сложность и низкая надежность, обусловленные наличием третьего фотодатчика н значительным количеством элементов управления. 25

Цель изобретения - упрощение и повышение надежности устройства.

Цель достигается тем, что в устройство, содержащее источник излучения, оптически связанный с первым и вторым фотодатчнками„ последовательно соединенные датчик скорости и элемент И, а также первый элемент ЗАПРЕТ, реверсивный счетчик и три триггера, введены второй и третий элементы

ЗАПРЕТ и последовательно соединенные четвертый триггер и четвертый элемент ЗАПРЕТ, выход которого подключен к первому выходу устройства, второй вход — к выходу третьего триг-40 гера, а третий вход — к первому входу первого, второго и третьего элементов ЗАПРЕТ и выходу элемента И, соединенного вторым входом с выходдом второго триггера, первый вход 45 которого подключен ко второму входу первого элемента ЗАПРЕТ, первому входу первого триггера и выходу первого фотодатчика, а второй вход — ко второму выходу устройства, выходу и пер-50 вому входу реверсивного счетчика и первому входу четвертого триггера, соединенного вторым входом с выходом второго фотодатчика, вторым входом третьего элемента ЗАПРЕТ и первым входом третьего триггера, второй вход которого подключен к выходу третьего элемента ЗАПРЕТ, выход nepmoro элемента ЗАПРЕТ соединен со вторым входом первого триггера, подключенного выходом ко второму входу второго элемента ЗАПРЕТ, выход кото- рого соединен со вторым входом счетчика.

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

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

6, элемент И 7, первый элемент

ЗАПРЕТ 8, первый триггер 9, второй элемент ЗАПРЕТ 10, счетчик ll второй триггер 12, третий элемент ЗАПРЕТ

13, третий триггер 14, четвертый элемент ЗАПРЕТ 15, четвертый триггер 16, - выходные сигналы устройства; Ч - скорость конвейера с предметом.

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

Перемещаемые конвейером предметы

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

В исходном положении центр схвата робота находится в точке 4 над фотодатчиком б. Конвейер 2 перемещает со скоростью Ч предмет 3. Принцип наведения схвата на центр предмета

3 заключается в том, что схват, перемещаемый приводом робота со скоростью ч по катету С, и предмет 3, двигаясь по катету Ес=де равнобедренного треугольника Асе, совместятся в точке С .

Так как предмет 3 перекрывает луч второго фотодатчика 6 раньше, чем его центр окажется в точке Е, то на отрезке Мн движения центра предмета

3, когда перекрыт луч второго фотодатчика 6, схват перемещается со скоростью Ч /2. Вследствие этого, после выхода предмета 3 из-под луча второго фотодатчика б, центр схвата и центр предмета 3 окажутся на равных расстояниях Рс = С от точки С

Теперь предмет 3 и схват будут двигаться со скоростью Ч и их центры совместятся. в точке с .

Расстояние АС, которое должен пройти схват, определяется как разность отрезков Аб и ВС, 6C =HF= EF.

Отрезок определяется при движении предмета между лучами первого и вто.— рого фотодатчика 5 и б.

В исходном положении в счетчике

1l записан код отрезка А5, все триггеры 9, 12, 14 и 16 обнулены, сигналы и равны нулю. При перекрытии предметом 3 луча первого фотодатчика 5 (центр предмета 3 — в точке К) сигналом фотодатчика триггер 12 переводится в единичное положение н импульсы датчика 4 будут проходить через элемент И 7 на прямой вход элемента ЗАПРЕТ 8 и прямой вход элемента ЗАПРЕТ 10. Так как при этом на инверсном входе элемента ЗАПРЕТ

8 и сбросовом входе триггера 9 сигнал станет нулевым, импульсы будут проходить через элемент ЗАПРЕТ 8 на счетный вход триггера 9, с выхо1121645 да которого с вдвое меньшей частотой импульсы пойдут на инверсный вход элемента ЗАПРЕТ 10, вычеркивая каждый второй импульс, пришедший на

его прямой вход. Таким образом, каждый второй импульс датчика 4, поступая с выхода элемента ЗАПРЕТ 10 на вычитающий вход счетчика 11, будет вычитаться из кода счетчика 11. Поэтому после выхода предмета из-под луча фотодатчика 5 (центр .предмета ° в точке L) из счетчика 11 вычтется код отрезка FL = KF = KL 2.

После выхода предмета 3 из-под луча фотодатчика 5 на его выходе и, соответственно, инверсном входе элемента ЗАПРЕТ 8 и сбросовом входе триггера 9 вновь появится единичный сигнал, на выходе триггера 9 (инверсном входе элемента ЗАПРЕТ 10) будет нулевой сигнал и все импульсы датчика 4 будут, проходя через элемент ЗАПРЕТ,10, вычитаться из счетчика ll. Так будет работаь схема на отрезке LM, пока предмет не перекрыл луч второго фотодатчнка 6. При этом из счетчика ll вычтется также и код отрезка LM .

При перекрытии предметом луча ,фотодатчика 6 (центр предмета 3в точке М) сигналом с его выхода триггер 16 переводится в единичное положение, на инверсном входе элемента ЗАПРЕТ 13 и сбросовом входе триггера 14 устанавливается нулевой сигнал. При этом на отрезке мй каждый второй импульс датчика 4 проходит через элемент ЗАПРЕТ 15 на выход к к приводу робота и схват движется as точки со скоростью /2. По

1 прежнему импульсы датчика 4 вычитаются из счетчика 11.

После выхода предмета 3 нз-под луча фотодатчнка 6 центр предмета будет в точке К, а центр схватав точке P . .При этом на инверсном входе элемента ЗАПРЕТ 13 и сбросовом входе триггера 14 появляется, единичный сигнал, на выходе триггера 14 (инверсном входе элемента

10 ЗАПРЕТ 15) устанавливается нулевой сигнал, и все импульсы датчика 4 проходят через элемент ЗАПРЕТ 15 на выход к приводу робота. Схват станет перемещаться из точки P со ско )5 ростью V ..

К этому моменту иэ счетчика вычтется код расстояния FL +LM + МЕ +

ЕК с FE + ИЕ FH + МЕ е ВС+ЯР, т.е. в счетчике останется код рассто яния Л8 — ВС вЂ” AP = PC . Схват и центр предмета, находясь на равных расстояниях PC = Hc от точки встречи С и двигаясь с одинаковой скоростью Ч (импульсы датчика 4 вычитаются из счетчика 11), совместятся в точке С . В этот момент счетчик 11 обнуляется, на его выходе появляется сигнал, При этом триггеры 12 и 16 опрокидываются, прерывая управление приводом робота от устройства адап30 тивного управления по выходу х, выдается сигнал у на систему программного управления роботом, которая осуществляет захват. предмета, и в счетчик ll по входу 9 вновь записы35 вается код расстояния AS.

Применение изобретения позволит упростить устройство и повысит его надежность.

1121645

Заказ 7980/36 Тираж 841 Подиисное

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

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

O М»ю

Ф аа аЮ

В Ф ° а

Филиал ППН Патеит, г.Ужгород, ул.Проектная,4

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

Редактор М.Товтин Техред М.Кузьма Корректор В,Бутяга