Стенд-тренажер для оценки качества задания программы перемещений манипулятора

(5 0 25 ОСУДАРСТВЕННО ИЗОБРЕТЕНИЯРИ ГКНТ СССР КОМИТЕТ ОТНРЫТИ ОПИС Е ИЗОБРЕТЕНИЯ СКОМУ СВИДЕТЕЛЬСТВ КА 1(56) Авторское свидетельство СССР 9 1240576, кл, В 25 Л 11/00, 1986, (54) СТЕНД-ТРЕНАЖЕР ДЛЯ ОЦЕНКИ КАЧЕСТВА ЗАДАНИЯ ПРОГРАММЫ ПЕРЕМЕЩЕНИЙ МАНИПУЛЯТОРА(57) Изобретение относится к робототехнике, Цель изобретения - расширение функциональных возможностей за счет увеличения числа измеряемых параметров при оценке качества задания программы перемещений манипулятора по пространственным траекториям Для этого одна часть устройства для регистрации положения конечного зветочкой траектории ремеще н обретение относится к роботот льного м вляется расши ть озможностеи за измеряемых качества задаений манипуляюй траектории, а блок-схема ения а в в мента и). Привоы к выхоравления.правления иг. 2 - констего инструментельная коортности заданныхнафиг, 4 и ошибок совмеция и на ф у выход т динатная сетка в окреточек позиционировани5 - схемы образованиящения рабочего инструм 5 вклю по ко атель аннои ента нике. Целью изобретения рение функциональных счет увеличения числа параметров при оценке ния программы перемещ тора по пространствен На фиг. 1 приведен стенда-тренажера; на Рук митатора рабо та 1 иг. 3 - измер,801511111 на контрольного манипулятора, установленная на основании стенда, выполнена в виде измерительной координатной сетки с нанесенной на нее траекторией перемещения, а цругая часть,установленная на конечном звене манипулятора, - в виде имитатора рабочегоинструмента с источником света и оптической системой, Стенд дополнительно снабжен блоком формирования измеряемых параметров, Перемещение манипулятора осуществляется операторомс помощью соответствующих кнопокпульта управления и блока программного управления. Оценка качества программирования производится по измеренным отклонениям имитатора рабочегоинструмента от заданных точек траектории, а также по показаниям электросекундомера пульта управления,1 з,п. ф-лы, 5 ил,ния.На конечном звене контронипулятора 1 установлена чаройства для регистрации .полконечного звена манипуляторимитатора 2 рабочего инстру(например, сварочной горелкды манипулятора 1 подключендам блока 3 программного уВход блока 3 программного уподключен к соответствующемпульта 4 управления, На пулравления расположены кнопкичения перемещения имитаторординатам Х, У, 2, переклю151113кнопки 7 "Пуск" и 8 "Стоп" элемент 9 индикации и электросекундомер 10, В состав стенда-тренажера входит так же блок 11 формирования измеряемых параметров, который содержит первый5 элемент 12 дифференцирования, триггер 13 управления, генератор 14 импульсов, элемент И 15, элемент 16 задержки, элемент ИЛИ 17, второй эле мент 18 дифференцирования, ключи 19 и 20, Вход первого элемента 12 дифференцирования через кнопку 7 "Пуск" пульта управления и вход второго элемента 18 дифференцирования через кнопку 8 "Стоп" пульта 4 управления подсоединены к шине нтания постоянного тока (Б). Выход первого элемента 12 дифференцирования подключен к второму входу триггера 13 управ ления. Генератор 14 импульсов через последовательно соединенные элементы И 15, элемент 16 задержки и элемент ИЛИ 17 связан с первым входом триггера 13 управления Второй вход 25 элемента ИЛИ 17.подключен к выходу второго элемента 18 дифференцирования. Выход триггеоа 13 управления соединен с вторым входом элемента И 15 и одновременного через первый 30 ключ 19 - с элементом индикации 9, а через второй ключ 20 - с электро- секундомером 10 пульта управления. Манипулятор 1 располагается на соответствующем основании стенда-тренажера.В рабочей зоне манипулятора 1 установлена вторая часть устройства для регистрации положения конечного звена манипулятора в виде располо женной на основании измерительной координатной сетки 21 и имитатора22 траектории перемещения с заданными исходной точкой 23 и промежуточными точками 24 позиционирования.Имитатор 2 рабочего инструмента содержит корпус 25, в нижней части которого имеется полость для размещения источника 26 света, который подключен через переключатель Ь пульта управления к шине питания. В нижнюю часть имитатора 2 вставлен торец 27 с имитатором 28 сварочного электрода, Внутри имитатора 28 имеется канал для прохождения световых лучей, а на конце имитатора 28 установлена оптическая система в виде фокусирующей линзы 29, В окрестности точек позиционирования, например точки 24 имитатора 22 линии соединения, нанесенакоординатная измерительная сетка 21.Работа на стенде осуществляется вдва этапа; первый этап подготовительным, а на втором осуществляется оценка качества программирования перемещений манипулятора, которое выполняютразличные операторы,На сетку 21 наносят имитатор 22пространственной траектории перемещения в виде прямой, ломаной линий, синусоидальной или другой кривой с нанесенными на ней исходной точкой 23и промежуточными точками 24 позиционирования. После этого на первом этапе оператор с помощью кнопок 5 включения пульта 4 управления послецовательно подключает блок 3 программного управления к соответствующему приводу манипулятора 1, обеспечивая перемещение имитатора 2 рабочего инструмента в некоторую исходную точку 23,Затем оператор с помощью переключателя 6 пульта 4 управления подключает источник 26 света имитатора 2к шине питания, По лучу света, выходящему из канала имитатора 28 электрода через Фокусирующую линзу 29,оператор путем управления перемещением имитатора 2 по координатам Х,У,добивается точного совмещения светового пятна с исходной точкой 23,Одновременно оператор устанавливаетзаданное положение имитатора 2 рабочего инструмента по отношению к траектории по координате 2, Положениеимитатора 2 относительно исходнойточки траектории по координатам Х,У, 2 Фиксируется с помощью концевыхвыключателей манипулятора 1, Приэтом на цифровом табло блока 3 программного управления величины перемещений должны быть равны нулю.Затем оператор выводит имитатор2 рабочего инструмента в заданнуюточку 24 имитатора 22 траектории итаким же образом по световому пятнусовмещает имитатор 2 с точкой 24 позиционирования по координатам Х, У,и устанавливает заданное расстояниедо торца имитатора 2 по координате Е,Это положение имитатора 2 соответствует его требуемому положению (точкаА на фиг. 4). После этого источник26 света отключается от шины питания.По числу зафиксированных импульсовна цифровом. табло блока 3 програм 151111инмного управления по каждой координате Х, У, 2 вычисляются величины перемещений имитатора 2 рабочего инструмента из исходной точки 23 в заданную точку 24 позиционирования имитатора 22 траектории. Точка 24 соответствует точке А , которая яв(ляется проекцией точки А на плоскость ХУ (фиг. 4), Величины исходных перемещений обозначены Хд, Уд, 2 д (фиг 4). Затем имитатор 2 рабочего инструмента выводится в исходную точку путем его движения по координатам Х, У, 2 до срабатывания концевых выключателей, Одновременно оператор устанавливает в нуль электросекундомер 1 О, а путем нажатия и отпускания кнопки 8 "Стоп" через второй элемент 18 дифференцирования в исходное состояние устанавливается триггер 13 управления.После этого проводится второй этап оценки качества программирования перемещений манипулятора разными операторами.Первоначально определяется величина ошибки позиционирования при установке имитатора 2 рабочего инструмента в заданную точку 24 за определенное время, Для этого путем выбора времени задержки с помощью элемента 16 задержки устанавливается продолжительность времени вывода конечного звена манипулятора 1 из исходной точки 23 в некоторую точку 24, Затем испытуемый оператор с помощью пульта 4 управляет процессом перемещения манипулятора: кратковременно нажимает и отпускает на пульте 4 кнопку 7 "Пуск", при этом скачок напряжения постоянного тока поступает на вход первого элемента 12 дифференцирования, с выхода которого положительный импульс поступает на второй вход триггера 13 управления, На выходе последнего устанавливается разрешающий потенциал, который поступает на второй вход элемента И 15 и на входы первого и второго ключей 19 и 20. Элемент И 15 открывается и пропускает на вход элемента 16 задержки импульсы с генератора 14. Частота импульсов генератора 14 выбирается равной порядка 2=1 Гц, Ключи 19 и 20 также открываются, в результате чего элемент 9 индика,ции и электросекундомер 10 подключаются к шине питания. Элемент 9 5 О 5 20 25 30 35 40 45 50 55 дикации загорается и сигнализирует оператору о вкщочении режима программирования перемещения, а электросекундомер 10 отсчитывает заданное время программирования. Одновременно с включением режима программирования оператор с помощью кнопок 5 пульта 4 начинает управлять процессом перемещения имитатора 2 рабочего инструмента из исходной точки 23 в заданную точку 24 по координатам Х, У, 2. При этом он стремится как можно точнее совместить имитатор 28 электрода с заданной точкой 24, визуально наблюдая за положением имитатора 28 электрода, Через некоторое заданное время на выходе элемента 16 задержки появляется импульс, который через элемент ИЛИ 17 поступает на первый вход триггера 13 управления, Последний устанавливается в исходное состояние, в результате чего элемент И 15 и ключи 19 и 20 закрываются, Элемент 9 индикации гаснет, а электросекундомер 10 останавливается, Погашенная лампочка является для оператора сигналом об окончании процесса программирования, а электросекундомер 10 фиксирует заданную величину времени программирования.Ошибка позиционирования вычисляется следующим образом,Пусть за заданное время программирования перемещения рабочего органа оператор установил его относительно некоторой точки 24 в точке В (фиг.4). Проекция этой точки на плоскость ХУ есть точка В . По числу зафиксированных импульсов на цифровом табло блока 3 программного управления по каждой координате Х, У, 2 вычисляются величины перемещений имитатора 2 из исходной точки 23 в окрестность некоторой точки 24 (точка В). Обозначим эти перемещения Х , У, 2, Тогда величины ошибок по каждой из координат определяются по выражениям Еу =Х -Хд 1; Е =у,-уд 1; Е = 2 -2 д . Суммарная ошибка позиционирования имитатора 2 рабочего инструмента в заданной точке траектории будет равна По суммарной величине ошибки позиционирования, которую допускаютразличные операторы за одно и то же время программирования, можно судить о возможностях операторов выполнять процесс программирования,Учитывая то, что допустимые зна 5 чения ошибок позиционирования по каждой координате имеют различную величину, для оценки качества программирования различными операторами можно воспользоваться критерием ка чества, который имеет следующий вид: з7,. й,.15 где Я; - составляющие ошибок позиционирования по координатам Х, У, Е;Л - весовые коэффициенты, которые можно принять как величины, обратно пропорциональные допустимым отклонениям имитатора 2 по координатам Х, У, Е; 20 25 30 1 1 1Я ээ кфк1"к ГХкДопустимые отклонения обычно принимают:"ф ,Ь = 1 х=Ь/21 , - 1 где й - диаметр электрода;Ь - ширина шва;351 - длина кратера в конце сварного шва (фиг. 5).При необходимости время программирования перемещения между точками может выбираться путем изменения 40 времени задержки элемента 16.Сократить время определения составляющих ошибок совмещения имитатора 2 рабочего инструмента с заданной точкой 24 имитатора 22 траектории 45 в плоскости ХУ на этапе предварительного обучения операторов можно если после вывода имитатора 2 в окрестность опорной точки 24 оператор с помощью переключателя 6 пульта 4 управления подключит к шине питания источник 26 света имитатора 2 рабочего инструмента. Тогда луч света, выходящий из имитатора 28 электрода и сфокусированный линзой 28, будет показывать на координатной измерительной сетке 21 величины смещения имитатора 2 в направлении координат Х и У по отношению к заданной точке 24 (фиг. 3). Величины ошибок в,этом случае оператор определяет визуально,Стенд-тренажер позволяет также проводить оценку качества программирования перемещения рабочего инструмента за время, которое выбирает сам оператор, Для этого он отключает выход элемента 16 задержки от входа элемента ИЛИ 17 (на фиг. 1 цепь отключения условно не показана). Затем оператор нажимает и отпускает кнопку 7 "Пуск" пульта 4, и, как в предыдущем случае, осуществляет управление перемещением имитатора 2 в некоторую точку 24. После того как оператор, с его точки зрения, достаточно точно совместил имитатор 2 с заданной точкой, он нажимает кнопку 8 "Стоп". По показаниям электросекундомера 10 определяется время программирования, а по световому пятну на координатной сетке 21 можно определить величины ошибок совмещения по координатам Х и У.формула изобретения1, Стенд-тренажер для оценки качества задания программы перемещений манипулятора, содержащий основание для установки контрольного манипулятора, связанного соответствующим образом с блоком программного управления и пультом управления, а также устройство для регистрации положения конечного звена манипулятора, выполненное из двух частей, имеющих возможность бесконтактного взаимодействия друг с другом, причем одна часть установлена на конечном звене манипулятора, а другая - на основании, о т л и ч а ю щ и й с я тем, что, с целью расширения функциональных. возможностей, он снабжен блоком формирования измеряемых параметров, связанным с пультом управления, при этом часть устройства для регистрации по-. ложения, установленная на конечном звене манипулятора, выполнена в виде имитатора рабочего инструмента, содержащего источник света и оптическую систему, а другая часть, установленная на основании, выполнена в виде измерительной координатной сетки с нанесенной на нее траекторией перемещения.12. Стенд-тренажер по п, 1, о т л и ч а ю щ и й с я тем, что блокформирования измеряемых параметров содержит последовательно соединенные генератор импульсов, элемент И, элемент задержки, элемент ИЛИ, триггер управления, а также два ключа и два элемента дифференцирования, выход первого из которых связан с вторым входом триггера управления, а выход второго элемента дифференцирования связан с вторым входом элемента ИЛИ, при этом выход триггера управления соединен с вторым входом элемента И) а также через ключи связан соответственно с элементом индикации и электросекундомером пульта управления, причем вход первого элемента дифференцирования через кнопку "Пуск" пульта управления, а вход второго элемента дифференцирования через кно 11 11пку Стоп пульта управления связаны с шиной питания, с которой также связан источник света имитатора рабочего инструмента через соответствующий переключатель пульта управления.оставитель И. Афонехред Л,Сердюкова ектор В, Кабаций кин актор одписн КНТ СССР изводственно-издательский комбинат "Патент", г, Ужгород, ул. Гагарина, 101 ЗаказВНИИПИ 846/20 Государ Тираж 778енного комитета13035, Москва,о изобретениям и открытиям35, Раушская наб., д. 4/5