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

 

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

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

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

РЕСПУБЛИК (я)з В 25 J 19/00

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

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

ПРИ ГКНТ СССР

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

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ о

Ql ч

Ql (21) 446762ф/08 (22) 29.07,88 (46) 23.06.91, Бюл, М 23 (71) Ленинградский институт авиационного приборостроения (72) А.Ю. Заозерский, Г.В. Нежданов, Н,А.

Дроздецкий, В,Н. Ильин, М.Е, Овчинников, А.К. Явленский и К.Н, Явленский (53) 621-229.72(088.8) (56) Авторское свидетельство СССР (Ф 1198554, кл. G 07 С 3/10, 1985, (54) УСТРОЙСТВО ДЛЯ КОНТРОЛЯ МАНИПУЛЯТОРА

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

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

На фиг. 1 представлена функциональная схема устройства: на фиг. 2 — схема формирователя импульса начала торможения; на фиг. 4 — схема шифратора; на фиг. 5— схема формирователя импульса окончания разгона; на фиг.б — схема таймера; на фиг. 7 — схема формирователя импульса окончания торможения, На фиг. 1 указаны датчик 1 ускорения, звено 2, манипулятор 3, усилитель 4, коммутатор 5, фильтр 6 низкой частоты, частотомер 7, блок 8 преобразователей (ЦАП), блок

9 компараторов, блок 10 индикации, блок 11 задатчиков сигнала, первый формирователь

12 импульса, шифратор 13, второй формиро„Я2,, 1657375 А1 (57) Изобретение относится к робототехнике и может быть использовано при создании стендов контроля и диагностики манипулягора. Целью изобретения является расширение функциональных возможностей устройства за счет обеспечения большей достоверности контроля, В устройство введены формирователи импульса, выпрямитель, пиковый детектор, фильтр низкой частоты, коммутатор, частотомер, таймер, блок индикации, блск преобразователей, блок компараторов и блок задатчиков сигнала, позвочяющий увеличить объем и глубину контроля манипулятора. 7 ил. ватель 14 импульса, таймер 15, интегратор

16, выпрямитель 17, компаратор 18, первый счетчик 19, пиковый детектор 20, ключ 21, второй счетчик 22, третий формирователь 23 импульса, датчики 24 положения, блок 25 управления, приводы 26, триггеры 27, светодиоды 28 и ключ 29, Коммутатор содержит фиг. 2) элемент И

30, элемент ИЛИ 31, ключ 32, элемент ИЛИНЕ 33, ключи 34 и 35, элемент И-НЕ 36, кчючи 37 и 38 и элемент НЕ 39.

Формирователь 12 импульса содержит (фиг. 3) выпрямитель 39 и компаратор 40.

Шифратор 13 (фиг. 4) включает в себя триггер 41, элемент ИЛИ-НЕ 42, триггеры

43 и 44, элемент ИЛИ вЂ” НЕ 45 и триггер 46.

Второй формирователь 14 импульса содержит (фиг, 5) фильтр 47 низкой частоты, детектор 48, одновибратор 49 и элемент И—

НЕ 50.

Таймер 15 (фиг. 6) включает в себя триггер 51, элемент И 52, счетчик 53, триггер 54, элемент И 55, счетчик 56, триггер 57, эле1657375 мент И 58, счетчик 59, генератор 60 и одновибратор 61.

Третий формирователь 23 импульса содержит (фиг, 7) детектор 62 и элемент

И вЂ” НЕ 63, устройство работает следующим образом.

При перемещении кинематического звена 2 манипулятора 3 по заданной координате имеются три характерные фазы движения: разгон, фаза установившегося движения и торможение, В данном устройстве полная реализация сигнала ускорения, воспринимаемого датчиком 1 ускорений при движении звена

2, разделяется на эти три фазы — разгона, установившегося движения и торможения путем определения моментов времени to, t1, t2, t3, где to — начало движения звена;

tl — конец разгона — начало установившегося движения; t2 — конец установившегося движения — начало торможения; 1з — конец торможения.

В каждой из фаз движения выделяются диагностические параметры, которые затем сравниваются с предельно допустимыми для исправного кинематического звена 2. В качестве диагностических параметров исгользуются пиковые ускорения при разгоне и торможении, степень равномерности ïåремещения в фазе установившегося движения, собственная частота колебаний и параметр затухания в фазе торможения, а также длительности фаз движения, Информация о прохождении диагностируемым кинематическим звеном 2 соответствующей фазы движения кодируется шифратором 13. В момент начала движения кинематического звена 2 с первого выхода блока 25 управления роботом подается сигнал "1" (разрешения начала движения) на привод 26 диагностируемого звена 2, одновременно этот же сигнал поступает на вход шифратора 13, В момент to начала движения сигнал "1" прикладывается к первому входу триггера 41 (фиг. 4), который переключается в MOMBHT to и на его выходе имеется уровень "1", который поступает на вход элемента ИЛИ вЂ” НЕ 42 и второй вход элемента

ИЛИ-НЕ 45, что вызывает сигнал "О" на их выходах, соответствующий фазе разгона (код 00). Сигнал "0" с первого и второго выходов шифратора 13 поступает на входы коммутатора 5 и переключает его таким образом, что его вход соединяется только с третьим и четвертым выходами. Сигнал "О" поступает (фиг. 2) на первый и второй входы элемента И-НЕ 36, на его выходе присутствует уровень "1", ключ 37 замкнут. Одновременно на выходе элемента ИЛИ- Н" 33

ГО

55 имеется сигнал "1", который через элемент

ИЛИ 31 замыкает ключ 32, этот же сигнал замыкает ключ 34, При этом сигнал ускорения с первого входа коммутатора 5 flpoxoдит через ключи 32, 34 и 37 на выходы коммутатора 5.

При разгоне звена 2 манипулятора 3 в фазе (tp, t<) возникает импульс ускорения, который регистрируется датчиком 1 ускорений. Сигнал ускорения с его выхода поступает через усилитель 4 на вход коммутатора 5 и далее с его третьего и четвертого выходов на пиковый детектор 20 и формирователь 14 импульса окончания разгона, Выделенное пиковым детектором 20 максимальное значение ускорения dmapc является диагностическим признаком и поступает через замкнутый ключ 21 на вход блока 9 компараторов. Поскольку в момент to уровень "1" поступает с выхода блока 25 управления роботом на вход шифратора 13, т.е, на триггео 46 (фиг, 4), последний перебрасывается

s состояние "1" на выходе, при этом ключ 21 замыкает свой вход на свой выход. Таким образом, максимальное значение пикового у корения aMGKc поступае1 на вход блока 9 компараторов. На соответствующий вход блока 9 с блока 11 поступает постоянное пороговое напряжение, соответствующее максимально допустимому ускорению для контролируемого звена 2. В случае превышения Величины дмахс порогового значения компаратор блока 9 вырабатывает сигнал

"0", который поступает на первый входтриггера 27 блока 10 индикации и перебрасывает его в состояние "1", При этом загорается соответствующий светодиод 28, свидетельствующий о том, что зафиксировано превышение предельного значения пикового ускорения при разгоне звена 2. В случае исправного состояния звена 2 превышения порогового уровня не просходит и светодиод 28 не горит.

Фаза разгона звена 2 манипулятора 3 происходит до момента tl, для определения которого служит формирователь 14 импульса окончания разгона. На интервале времени (to, ti) на фильтр 47 низкой частоты формирователя 14 (фиг, 5) поступает сигнал ускорения. Фильтр 47 служит для повышения помехозащищенности формирователя

14, имеет частоту среза 100 Гц и пропускает только сигнал, возникающий при ускорении кинематического звена 2. На выходе фильтра 47 низкой частоты образуется низкочастотный сигнал ускорения, поступающий на детектор 48, на выходе которого формируется однополярный сигнал ь4ых > О, свидетельствующий о том, что было движение звена на интервале (t, tl). Этот сигнал

1657375 выходе имеется положительное пульсирующее напряжение. Это напряжение поступает на вход компаратора 18, на входе с блока

9 которого устанавливается максимально допустимое пороговое значение Опорог 1 неравномерности скорости.

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

В случае неравномерного движения диагностируемого звена 2 манипулятора 3 наблюдаются выбросы сигнала скорости эа значение Unoporg . Тогда в момент превышения порогового значения на выходе компа45

55 запускает одновибратор 49 так. что на входе элемента И вЂ” НЕ 50 имеется напряжение "0", Длительность импульса одновибратора 49 заведомо установлена больше длительности фазы разгона(to, t>), При этом к моменту 5 ц начала установившегося движения на выходе детектора 48 имеется нулевое напряжение, которое поступает на вход элемента

И-НЕ 50, а значит, на ее выходе появляется сигнал "1", который поступает на вход шиф- 10 ратора 13 как сигнал окончания разгона, Шифратор 13 при этом в момент 1 сформирует код (01), соответствующий фазе установившеocR движения. В момент т1 поступления уровня

"1" (фиг. 4) на первый вход триггера 43 иэ 15 формирователя 14 импульса окончания разгона на выходе триггера 43 появляется уровень

"1" (фиг. 5), При этом триггер 41 устанавливается в состояние "0" на выходе, на выходе элемента ИЛИ вЂ” НЕ 42 имеется сигнал "0", а 20 на выходе элемента ИЛИ вЂ” НЕ 45 — сигнал

"1". Таким образом формируется код 01 на всем интервале (tx t Q фазы установившегося движения: На втором входе ком лутаторэ

5 имеется уровень "0", а на третьем входе — 25 уровень "1". При этом коммутатор 5 соединяет первый вход с вторым выходом, Второй ключ замкнут и сигнал ускорения с первого входа коммутатора 5 поступает на второй его выход и далее на интегратор 16 30 и формирователь 12 импульса начала горможения, На интервале (t 1, t2) установившегося движения диагностическим признаком является равномерность скорости движения 35 звена 2 манипулятора 3. Интегратор 16 из сигнала ускорения формирует сигнал, пропорциональный переменной составляющей скорости

0 = - J a(t)dtЧ(1), где a(t) — ускорение звена.

Выпрямитель 17 осуществляет операцию взятия модуля над сигналом U. Ha его ратора 18 появляются импульсы напряжения в соответствии с формулой

1 при Овыпр 0порог ;

0вых.комп

0 при Овыпрс0порог1

Первый счетчик 19 подсчитывает число и импульсов с уровнем "1", Значение п поступает в двоичном параллельном ходе на вход блока 8 ЦАП. На выходе соответствующего цифроаналогового преобразователя блока 8 образуется постоянное напряжение, которое поступает на вход компаратора блока 9. В нем происходит сравнение с пороговым значением сигнала, поступающим с блока 11. В случае превышения постоянным напряжением порогового значения компаратор 9 через триггер 27 зажигает соответствующий светодиод 28. Сброс первого счетчика !9 производится перепадом напряжения, поступающим на его вход в момент ti окончания фазы разгона с выкода формирователя 14 импульса окончания разгона. При этом перед каждой следующей фазой установившегося движения первый счетчик 19 Обнуляется и готов к счету.

Момент t2 окончания фазы установившегося движения определяется с помощью формирователя 12 импульса начала торможения, В момент t2 происходит торможение звена 2 манипулятора 3, возникает (фиг, 3) импульс ускорения, который поступает на выпрямитель 39, Он выделяет модуль значеНИЯ ИМПУЛЬСа УСКОРЕНИЯ (таК КаК а2макс МО жет быть положительным и отрицательным в зависимости от направления движения вперед или назад), который подается на вход компаратора 40. На другой вход последнего поступает пороговое напряжение

0порог.2, С ВЫХОДа бЛОКа 11. ПОРОГОВОЕ Напряжение 0поро .z имеет определенное значение для каждого кинематического звена 2. В момент превышения порогового знаЧЕНИя 0порог.у ИМПУЛЬСОМ а2макс На ВЫХОдв компаратора 40 образуется перепад напряжения, соответствующий моменту t2 начала торможения. Этот перепад поступает на вход шифратора 13 При этом шифратор 13 в момент t2 формирует код (10), соответствующий фазе торможения. Уровень "1" поступает на вход триггера 44 (фиг. 4), у которого на выходе появляется уровень "1", что вызывает переброс триггера 43 в положение "0" на выходе. При этом на первом выходе шифратора 13 имеется уровень "1", а на втором — "0".

Этот код поступает на входы коммутатора 5 и переключает его таким образом, что входной сигнал поступает только на первый и третий выходы (на выходе элемента И 30 (фиг. 2) имеется "1", замыкаются ключи 32 и 35).

1657375

Сигнал ускорения поступает на фильтр

6 низкой частоты и пиковый детектор 20, Последний выделяет величину максимальНОГО УСКОРЕНИЯ а2<акс На УЧаСтКЕ ГОРМОжЕния, которая поступает на вход ключа 21, Поскольку в фазе торможения в момент tz перепад с выхода формирователя 12 импульса начала торможения поступает на триггер 46 (фиг, 4), он переходит в состояние

"0" и переключает ключ 21 так, что на вход соответствующе о компараторэ блока 9 посгупает сигнал ускорения а2а„, На втором входе этого компаратора блока 9 устанавливается постоянное напряжение с потенциометра блока 11, соответствующее предельному значению ускорения в фазе торможения.

С выхода фильтра 6 низкой частоты сигнал поступает на частотомер 7, который определяет частоту основного резонанса F, характеризующую жесткостные свойства звена 2 манипулятора 3. При ухудшении технического состояния (поломки подшипников, пластические деформации, износ) жесткость уменьшается, что фиксируется уменьшением F. Величина частоты F в коде поступает с первого выхода частотомера 7 на блок 8, где преобразуется в постоянное напряжение, Сравнение этого напряжения с пороговым происходит в компараторе блока 9, Если величина F меньше порогового значения, то соответствующий триггер 27 зажигает светодиод 28, что свидетельствует о неисправности.

С выхода частотомера 7 на второй счетчик 22 поступают импульсы, соответствующие периоду собственных колебаний звена

2 манипулятора То = — . Второй счетчик 22

F подсчитывает число mполных периодов,,которые характеризуют степень демпфирования манипулятора 3 (она зависит от технического состояния элементов фиксации, муфт, тормозов и др. элементов). Величина m е коде поступает на ЦАП блока 8, где преобразуется в постоянное напряжение, которое е соответствующем компараторе блока 9 сравнивается с пороговым. В случае превышения величиной m порогового значения загорается соответствующий светодиод гв, Сброс второго счетчика 22 и частотомера 7 производится перепадом напряжения, поступающего на вторые входы в момент t> окончания фазы разгона с выхода формирователя 14 импульса окончания разгона. При этом перед каждой следующей фазой торможения счетчик 22 и частотомер 7 обнуляются.

Момент tg окончания движения звена определяется формирователем 23 импульса окончания торможения. Сигнал с выхода фильтра 6 низкой частоты поступает на детектор 62 формирователя 23 (фиг. 7). При полном окончании колебаний звена 2 выходное напряжение фильтра 6 равно нулю и приложено к входу элемента И вЂ” НЕ 63, Для исключения ложного срабатывания формирователя 23 при незапрограммированных остановках звена на его вход, т.е, на вход элемента И-НЕ 63. также поступает сигнал

"0" от эадатчика 24 конечного положения, свидетельствующий о том, что звено 2 находится B конечном положении.

Время выполнения отдельной фазы движения является также диагностическим признаком звена 2 манипулятора 3. Поэтому для контроля фаэ движения по длительности служит таймер 15. На его входы последовательно поступают импульсы в соответствУющие моменты вРемени tp, 11, t2, t3, В момент tp с выхода блока 25 управления роботом поступает перепад напряжения при начале движения звена 2, в момент t>— сигнал "1" из формирователя 14 импульса окончания разгона, е момент tz — сигнал "1" из формирователя 12 импульса начала торможения, в момент t3 — сигнал "1" из формирователя 23 импульса окончания торможения, В момент tp перепад напряжения поступает на вход триггера 51 (фиг, 6) и одновибратор 61. На выходе одновибратора

61 вырабатывается короткий импульс, который сбрасывает счетчики 53, 56 и 59, а на выходе триггера 51 устанавливается "1", В момент t окончания разгона на вход таймера 15 поступает "1" из формирователя 14 окончания разгона. При этом триггер 51 вырабатывает на выходе "0", а второй триггер 54 — "1". Прямоугольный импульс (tp, ti), задающий продолжительность счета, поступает на элемент И 52, который заполняется импульсами от генератора 60 счетных импульсов, Число импульсов, подсчитанное счетчиком 53, прямо пропорционально длительности интервала (tp, t>), Аналогичным образом работают остальные два канала таймера 15, измеряя длительность интервалов (ti. t2), (t2, сз), соответствующих фазам установившегося движения и торможения.

С выходов счетчиков 53, 56 и 59 величина длительности фазы разгона (tp, ti), фазы установившегося движения (tg, ta) и фазы торможения (tz, ul в коде поступает соответственно на ЦАП блока 8, на выходе которых образуются постоянные напряжения, поступающие на первые входы компараторов блока 9, Если длительность какой-либо фазы превышает пороговое значение, устанавли1657375

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

Таким образом, после окончания движения звена 2 полученные значения диагностических признаков: пиковые ускорения а1макс и а2макс, величина резонансной частоты F, число периодов колебаний m, величина и, характеризующая равномерность движения и длительность фаз (to, t1), (t1 t2), (tz, u), сравниваются с предельно допустимыми, а результат сравнения отображается на блоке 10 индикации. На основе анализа его состояния принимается решение об исправности или неисправности кинематического звена 2, в блоке 11 устанавливают новые пороговые значения и кратковременно замыкается ключ 38, при этом срабатывают все триггеры 27 и все светодиоды 28 гаснут.

Датчик 1 укрепляют на следующем диагностируемом звене 2 так, чтобы его ось чувствительности совпадала с направлением его движения. Вход формирователя 23 импульса окончания торможения подключают, например, к датчику 24 конечного положения этого звена 2. Вход шифратора 13 подключают к входу привода 26 укаэанного звена 2, диагностику которого проводят аналогичным образом, Формула изобретения

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

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

2б йб

2б

Фиг. 1 ьтра б

&оо ка 1О

mopa Q

1657375

1657375 фО

С Eb/X. фориор. с 8b/X. РО,ЮРЫЧКО. а 4гО

Юб с 8b/x.

ЩОРС/ 0.

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

Редактор М.Янкович Техред М.Моргентал Корректор Т.Малец

Производственно-издательский комбинат "Патент", г. Ужгород, ул,Гагарина, 101

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

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

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