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

(56) Авторское с1 Ф 1198554, кл. юл, %23 кий институт авиа нно рский, Г.В. НежданН. Ильин, М.Е, Овчии К.Н, Явленский 88.8)видетельство СССР6 07 С 3/10, 1985,Н,А,ков,(54) УСТРОЙСПУЛЯТОРА О ДЛЯ КОНТРО А 54,ГОСУДАРСТВЕННЫИ КОМИТЕТПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМПРИ ГКНТ СССР ОПИСАНИЕ КОМУ СВИДЕТЕЛЬС Изобретение относится к области робототехники и может быть использовано при создании стендов контроля и диагностики манипулятора.Целью изобретения является расширение функциональных возможностей устройства за счет обеспечения большей достоверности контроля.На фиг. 1 представлена функциональная схема устройства: на фиг. 2 - схема формирователя импульса начала торможения; на фиг. 4 - схема шифратора; на фиг. 5 - схема формирователя импульса окончания разгона; на фиг.6 - схема таймера; на фиг. 7 - схема формирователя импульса окончания торможения,На фиг. 1 указаны датчик 1 ускорения, звено 2, манипулятор 3, усилитель 4, коммутатор 5, фильтр 6 низкой частоты, частотомер 7, блок 8 преобразователей (ЦАП), блок 9 компараторов, блок 10 индикации, блок 11 задатчиков сигнала, первый формирователь 12 импульса, шифратор 13, второй формиро.(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, триггер элемент И 55, счетчик 56, триггер 57, эле 1657375мент И 58, счетчик 59, генератор 60 и одно- вибратор 61.Третий формирователь 23 импульса содержит (фиг, 7) детектор 62 и элемент И - НЕ 63,устройство работает следующим образом.При перемещении кинематического звена 2 манипулятора 3 по заданной координате имеются три характерные фазы движения: разгон, фаза установившегося движения и торможение,В данном устройстве полная реализация сигнала ускорения, воспринимаемого датчиком 1 ускорений при движении звена 2, разделяется на эти три фазы - разгона, установившегося движения и торможения путем определения моментов времени 1 о, 11, 12, 1 З, ГдЕ то - НацаЛО дВИжЕНИя ЗВЕНа; т 1 - конец разгона - начало установившегося движения; т 2 - конец установившегося движения - начало торможения; 1 з - конец торможения.В каждой из фаз движения выделяются диагностические параметры, которые затем сравниваются с предельно допустимыми для исправного кинематического звена 2, В ючестве диагностических параметров используются пиковые ускорения при разгоне и торможении, степень равномерности перемещения в фазе установившегося движения, собственная частота колебаний и параметр затухания в фазе торможения, а также длительности фаз движения,Информация о прохождении диагностируемым кинематическим звеном 2 соответствующей фазы движения кодируется шифратором 13. В момент начала движения кинематического звена 2 с первого выхода блока 25 управления роботом подается сигнал "1" (разрешения начала движения) на привод 26 диагностируемого звена 2, одновременно этот же сигнал поступает на вход ШИфратсра 13, В МОМЕНТ 1 о НацаЛа дВИжЕ- ния сигнал "1" прикладывается к первому входу триггера 41 (фиг, 4), который переключается в момент 1 о и на его выходе имеется уровень "1", который поступает на вход элемента ИЛИ - НЕ 42 и второй вход элемента ИЛИ-НЕ 45, что вызывает сигнал "0" на их выходах, соответствующий фазе разгона (код 00). Сигнал "0" с первого и второго выходов шифратора 13 поступает на входы коммутатора 5 и переключает его таким образом, что его вход соединяется только с третьим и четвертым выходами. Сигнал "0" поступает (фиг, 2) на первый и второй входы элемента И-НЕ Зб, на его выходе присутствует уровень "1", ключ 37 замкнут. Одновременно на выходе элемента ИЛИ-Р" 33 5 10 15 20 25 30 35 40 45 ГО 55 имеется сигнал "1", который через элемент ИЛИ 31 замыкает ключ 32, этот же сигнал замыкает ключ 34, При этом сигнал ускорения с первого входа коммутатора 5 проходит через ключи 32, 34 и 37 на выходы коммутатора 5.При разгоне звена 2 манипулятора 3 в фазе (1 о, 11) возникает импульс ускорения, который регистрируется датчиком 1 ускорений, Сигнал ускорения с его выхода поступает через усилитель 4 на вход коммутатора 5 и далее с его третьего и четвертого выходов на пиковый детектор 20 и формирователь 14 импульса окончания разгона, Выделенное пиковым детектором 20 максимальное значение ускорения б,пас является диагностическим признаком и поступает через замкнутый ключ 21 на вход блока 9 компараторов. Поскольку в момент то уровень "1" поступает с выхода блока 25 управления роботом на вход шифратора 13, т.е, на триггео 4 б (фиг, 4), последний перебрасывается в состояние "1" на выходе, при этом ключ 21 замыкает свой вход на свой выход, Таким Образом, максимальное значение пикового у корения айзакс поступае 1 на вход блока 9 компараторов. На соответствующий вход блока 9 с блока 11 поступает постоянное пороговое напряжение, соответствующее максимально допустимому ускорению для контролируемого звена 2. В случае превы- ШЕНИЯ ВЕЛИЧИНЫ дмакс ПОРОГОВОГО ЗНдЧЕНИЯ компаратор блока 9 вырабатывает сигнал "0", который поступает на первый входтриггера 27 блока 10 индикации и перебрасывает его в состояние "1", При этом загорается соответствующий светодиод 28, свидетельствующий о том, что зафиксировано превышение предельного значения пикового ускорения при разгоне звена 2, В случае исправного состояния звена 2 превышения порогового уровня не просходит и светодиод 28 не горит.Фаза разгона звена 2 манипулятора 3 происходит до момента т 1, для определения которого служит формирователь 14 импульса окончания разгона, На интервале времени (1 о, т 1) на фильтр 47 низкой частоты формирователя 14 (фиг, 5) поступает сигнал ускорения. Фильтр 47 служит для повышения помехозащищенности формирователя 14, имеет частоту среза 100 Гц и пропускает только сигнал, возникающий при ускорении кинематического звена 2. На выходе фильтра 47 низкой частоты образуется низкочастотный сигнал ускорения, поступающий на детектор 48, на выходе которого формируется однополярный сигнал ОныхО, свидетельствующий о том, что было движение звена на интервале (ь, т 1). Этот сигнал45 выходе имеется положительное пульсирующее напряжение. Это напряжение поступает на вход компаратора 18, на входе с блока 9 которого устанавливается максимально допустимое пороговое значение Опорог 1 неравномерности скорости.Пороговое значение Опорог поступает в виде постоянного напряжения с выхода порогового блока 11 и имеет разное значение для каждого звена робота. 50 В случае неравномерного движения диагностируемого звена 2 манипулятора 3 наблюдаются выбросы сигнала скорости эа значение Опорог . Тогда в момент превышения порогового значения на выходе компа 55 запускает одновибратор 49 так, что на входеэлемента И - НЕ 50 имеется напряжение "0",Длительность импульса одновибратора 49заведомо установлена больше длительности фазы разгона(то,11), При этом к моменту 5ц начала установившегося движения на выходе детектора 48 имеется нулевое напряжение, которое поступает на вход элементаИ-НЕ 50, а значит, на ее выходе появляетсясигнал "1", который поступает на вход шифратора 13 как сигнал окончания разгона,Шифратор 13 при этом в момент 11 сформируеткод (01), соответствующий фазе установившегося движения. В момент 11 поступления уровня"1" (фиг. 4) на первый вход триггера 43 иэ 15формирователя 14 импульса окончания разгона на выходе триггера 43 появляется уровень"1" (фиг. 5), При этом триггер 41 устанавливается в состояние "0" на выходе, на выходеэлемента ИЛИ - НЕ 42 имеется сигнал "0", а 20на выходе элемента ИЛИ - НЕ 45 - сигнал"1". Таким образом формируется код 01 навсем интервале(11,в) фазы установившегося движения: На втором входе ком лутаторэ5 имеется уровень "0", а на третьем входе - 25уровень "1". При этом коммутатор 5 соединяет первый вход с вторым выходом, Второй ключ замкнут и сигнал ускорения спервого входа коммутатора 5 поступает навторой его выход и далее на интегратор 16 30и формирователь 12 импульса начала торможения,На интервале ( 1 1, с 2) установившегосядвижения диагностическим признаком является равномерность скорости движения 35звена 2 манипулятора 3. Интегратор 16 изсигнала ускорения формирует сигнал, пропорциональный переменной составляющейскоростиО=-а(т)с 3 ЬЧ(1),где а(т) - ускорение звена.Выпрямитель 17 осуществляет операцию взятия модуля над сигналом О. На его ратора 18 появляются импульсы напряжения в соответствии с формулой1 при ОвыпрОпорогМОвых.комп0 при ОвыпрсОоорог 1Первый счетчик 19 подсчитывает число и импульсов с уровнем "1", Значение п поступает в двоичном параллельном ходе на вход блока 8 ЦАП, На выходе соответствующего цифроаналогового преобразователя блока 8 образуется постоянное напряжение, которое поступает на вход компаратора блока 9, В нем происходит сравнение с пороговым значением сигнала, поступающим с блока 11, В случае превышения постоянным напряжением порогового значения компаратор 9 через триггер 27 зажигает соответсгвующий светодиод 28. Сброс первого счетчика 9 производится перепадом напряжения, поступающим на его вход в момент т 1 окончания фазы разгона с выкода формирователя 14 импульса окончания разгона. При этом перед каждой следующей фазой установившегося движения первый счетчик 19 Обнуляется и готов к счету.Момент 12 окончания фазы установившегося движения определяется с помощью формирователя 12 импульса начала торможения, В момент 12 происходит торможение звена 2 манипулятора 3, возникает (фиг, 3) импульс ускорения, который поступает на выпрямитель 39, Он выделяет модуль значе- НИЯ ИМПУЛЬСа УСКОРЕНИЯ (таК КаК а 2 мвкс МО- жет быть положительным и отрицательным в зависимости от направления движения вперед или назад), который подается на вход компаратора 40, На другой вход последнего поступает пороговое напряжение Опорог.Я, С ВЫХОДа бЛОКа 11, ПОРОГОВОЕ НаПРЯЖЕНИЕ Опорог ИМЕЕТ ОПРЕДЕЛЕННОЕ значение для каждого кинематического звена 2. В момент превышения порогового знаЧЕНИя Опорог О, ПУЛЬСОМ д 2 макс На ВЫХОДЕ компаратора 40 образуется перепад напряжения, соответствующий моменту и начала торможения, Этот перепад поступает на вход шифратора 13 При этом шифратор 13 в момент 12 формирует код(10), соответствующий фазе торможения. Уровень "1" поступает на вход триггера 44 (фиг. 4), у которого на выходе появляется уровень "1", что вызывает переброс триггера 43 в положение "0" на выходе. При этом на первом выходе шифратора 13 имеется уровень "1", а на втором - "0". Этот код поступает на входы коммутатора 5 и переключает его таким Образом, что входной сигнал поступает только на первый и третий выходы (на выходе элемента И 30 (фиг, 2) имеется "1", замыкаются ключи 32 и 35).5 10 15 20 25 30 35 40 45 50 55 Сигнал ускорения поступает на фильтр 6 низкой частоты и пиковый детектор 20, Последний выделяет величину максималь- НОГО УСКОРЕНИЯ а 2 макс На УЧаСтКЕ ГОРМОЖЕ- ния, которая поступает на вход ключа 21, Поскольку в фазе торможения в момент 12 перепад с выхода формирователя 12 импульса начала торможения поступает на триггер 46 (фиг, 4), он переходит в состояние "0" и переключает ключ 21 так, что на вход соответствующего компаратора блока 9 посгУпает сигнал УскоРениЯ а 2 макс На втоРОм входе этого компаратора блока 9 устанавливается постоянное напряжение с потенциометра блока 11, соответствующее предельному значению ускорения в фазе торможения,С выхода фильтра 6 низкой частоты сигнал поступает на частотомер 7, который Определяет частоту основного резонанса Е, характеризующую жесткостные свойства звена 2 манипулятора 3. При ухудшении технического состояния (поломки подшипников, пластические деформации, износ) жесткость уменьшается, что фиксируется уменьшением Р. Величина частоты Г в коде поступает с первого выхода частотомера 7 на блок 8, где преобразуется в постоянное напряжение, Сравнение этого напряжения с пороговым происходит в компараторе блока 9, Если величина Г меньше порогового значения, то соответствующий триггер 27 зажигает светодиод 28, что свидетельствует о неисправности. С выхода частотомера 7 на второй счетчик 22 поступают импульсы, соответствующие периоду собственных колебаний звена12 манипулятора Т 0 = - , Второй счетчик 22Еподсчитывает число Гп полных периодов, которые характеризуют степень демпфирования манипулятора 3 (она зависит от технического состояния элементов фиксации, муфт, тормозов и др. элементов), Величина гп в коде поступает на ЦАП блока 8, где преобразуется в постоянное напряжение, которое в соответствующем компараторе блока 9 сравнивается с пороговым. В случае превышения величиной л 1 порогового значения загорается соответствующий светодиод гв,Сброс второго счетчика 22 и частотомера 7 производится перепадом напряжения, поступающего на вторые входы в момент 11 окончания фазы разгона с выхода формирователя 14 импульса окончания разгона. При этом перед каждой следующей фазой торможения счетчик 22 и частотомер 7 обнуляются. Момент 1 з окончания движения звена определяется формирователем 23 импульса окончания торможения. Сигнал с выхода фильтра 6 низкой частоты поступает на детектор 62 формирователя 23 (фиг. 7), При полном окончании колебаний звена 2 выходное напряжение фильтра 6 равно нулю и приложено к входу элемента И - НЕ 63, Для исключения ложного срабатывания формирователя 23 при незапрограммированных остановках звена на его вход, т.е, на вход элемента И-НЕ 63. также поступает сигнал "0" от эадатчика 24 конечного положения, свидетельствующий о том, что звено 2 находится в конечном положении.Время выполнения отдельной фазы движения является также диагностическим признаком звена 2 манипулятора 3. Поэтому для контроля фаэ движения по длительности служит таймер 15, На его входы последовательно поступают импульсы в соответствующие моменты времени ь, 11, 12, 1 з, В момент 1, с выхода блока 25 управления роботом поступает перепад напряжения при начале движения звена 2, в момент т 1 - сигнал "1" из формирователя 14 импульса окончания разгона, в момент т 2 - сигнал "1" из формирователя 12 импульса начала торможения, в момент 1 з - сигнал "1" из формирователя 23 импульса окончания торможения, В момент 1 р перепад напряжения поступает на вход триггера 51 (фиг, 6) и одновибратор 61. На выходе одновибратора 61 вырабатывается короткий импульс, который сбрасывает счетчики 53, 56 и 59, а на выходе триггера 51 устанавливается "1",В момент т г окончания разгона на вход таймера 15 поступает "1" из формирователя 14 окончания разгона. При этом триггер 51 вырабатывает на выходе "0", а второй триггер 54 - "1". Прямоугольный импульс (10, О), задающий продолжительность счета, поступает на элемент И 52, который заполняется импульсами от генератора 60 счетных импульсов, Число импульсов, подсчитанное счетчиком 53, прямо пропорционально длительности интеРвала (тс, т 1), Аналогичным образом работают остальные два канала таймера 15, измеряя длительность интервалов (11. 12), (тг, 1 з), соответствующих фазам установившегося движения и торможения.С выходов счетчиков 53, 56 и 59 величина длительности фазы разгона (то, 11), фазы установившегося движения (1, ту) и фазы торможения (т 2, тз) в коде поступает соответственно на ЦАП блока 8, на выходе которых образуются постоянные напряжения, поступающие на первые входы компараторов блока 9, Если длительность какой-либо фазы превышает пороговое значение, устанавли 1657375 10ваемое в блоке 11, то срабатывает соответствующий компаратор блока 9 и загорается светодиод блока 10, соответствующий фазе движения, что свидетельствует о неисправности.Таким образом, после окончания движения звена 2 полученные значения диагностических признаков: пиковые ускорения а 1 макс И а 2 макс, ВЕЛИЧИНа РЕЭОНаНСНОй Частоты Е, число периодов колебаний в, величина и, характеризующая равномерность движения и длительность фаз (то, 11), (11, 12), (т 2, сэ), сравниваются с предельно допустимыми, а результат сравнения отображается на блоке 10 индикации. На основе анализа его состояния принимается решение об исправности или неисправности кинематического звена 2, в блоке 11 устанавливают новые пороговые значения и кратковременно замыкается ключ 38, при этом срабатывают все триггеры 27 и все светодиоды 28 гаснут.Датчик 1 укрепляют на следующем диагностируемом звене 2 так, чтобы его ось чувствительности совпадала с направлением его движения. Вход формирователя 23 импульса окончания торможения подключают, например, к датчику 24 конечного положения этого звена 2. Вход шифратора 13 подключают к входу привода 26 укаэанного звена 2, диагностику которого проводят аналогичным образом,Формула изобретения Устройство для контроля манипулятора, содержащее блок управления, выходы которого соединены с входом приводов звеньев манипулятора, а входы - с выходом датчиков положения, установленный на контролируемом звене датчик ускорения, подключенный выходом к входу усилителя, последовательно соединенные компаратор и первый счетчик, а также второй счетчик, ключ и интегратор, о т л и ч а ю щ е е с я тем, что, с целью расширения функциональных возможностей устройства за счет обеспечения большей достоверности. контроля, оно дополнительно содержит блок индикации, блок компараторов, блок задатчиков 5 10 15 20 25 30 35 40 45 сигнала, блок преобразователей, три фор-. мирователя импульса, выпрямитель, пиковый детектор, таймер, шифратор и последовательно соединенные коммутатор, фильтр низкой частоты и частотомер, первый выход которого подключен к первому входу второго счетчика, а второй выход - к первому входу блока преобразователей, соединенного вторым входом с выходом первого счетчика, третьим входом - с выходом второго счетчика, четвертым, пятым и шестым входами - с выходами таймера, а шестью выходами - с соответствующими входами блока компараторов. седьмой и восьмой входы которого подключены соответственно к первому и второму выходам ключа, входы с девятого по шестнадцатый - соответственно к выходам с первого по восьмой блока задатчиков сигнала, а выходы - к соответствующим входам блока индикации, первый вход ключа соединен с выходом пикового детектора, а второй вход - с первым выходом шифратора, подключенного первым, вторым и третьим входами к соответствующим входам таймера и к выходу соответствующих формирователей импульса, четвертым входом - к соответствующему входу таймера и к одному иэ выходов блока управления, а вторым и третьим выходами - соответственно к первому и второму входам коммутатора, третий вход которого соединен с выходом усилителя, второй выход - с входом пикового детектора, третий выход - с входом интегратора и первого формирователя импульса, а четвертый выход - с входом второго формирователя импульса, подключенного выходом к второму входу первого и второго счетчиков и частотомера, выход интегратора через выпрямитель соединен с первым входом компаратора, второй вход которого подключен к девятому выходу блока задатчиков сигнала, соединенного десятым выходом с вторым входом первого формирователя импульса, выход одного иэ датчиков положения подключен к первому входу третьего формирователя импульса, второй вход которого соединен с выходом фильтра низкой частоты.1657375 с Рвх.ЖОР ИиР.с алых.Од,ОРАЛО.с дыя.ЩОРС. 2 ФО Юб Составитель Е.Политоведактор М.Янкович Техред М.Моргентал рректор Т.Мал оизводственно-издательский комбинат "Патент", г. Ужгород, ул,Гагарина, 10 эз 1682 Тираж 475 Подписное ВНИИПИ Государственного комитета по изобретениям и открытиям при ГКНТ ССС 113035, Москва, Ж, Раушская наб 4/5