Устройство управления звеном манипулятора с рекуперацией энергии

 

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

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

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

РЕСПУБЛИК ((9) (Щ (st)s В 25 J 9/00

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

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

ПРИ ГКНТ СССР

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

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4726154/08 (22) 03.08.89 (46) 07.02.92. Ьюл. N 5 (71) Институт машиноведения им. А. А, Ьлагонравова (72) А. И. Корендясев и С. В. Левин (53) 62-229.72(088.8) (56) IV Всесоюзное совещание по робототех-. ническим системам. Киев, 27 — 29.10,87, ч. t—

Институт кибернетики им. В. M. Глушкова, изд, АН УССР. (54) УСТРОЙСТВО УПРАВЛЕНИЯ ЗВЕНОМ

МАНИПУЛЯТОРА С РЕКУПЕРАЦИЕЙ

ЭНЕРГИИ

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

Цель изобретения — упрощение системы управления звеном манипулятора с рекуперацией энергии.

На фиг. 1 изображена кинематическая схема манипулятора; на фиг. 2 — схема системы управления его подвижным звеном.

Устройство содержит подвижное звено

1, связанное с основанием 2 упругими элементами 3 и 4. На подвижном звене имеются фиксаторы 5 и 6, ответные части 7 и 8 которых размещены на основании. Подвижное звено связано с приводным двигателем

9, На подвижном звене размещен постоянный магнит 10, а на основании в середине траектории движения звена — магнитоуправляемый переключатель 11, выполненный, например, в виде геркона. Один из (57) Изобретение относится к машиностроению. Цель изобретения — упрощение системы управления звеном манипулятора с рекуперацией энергии. Поставленная цель достигается тем, что алгоритм управления, - связан с замером и запоминанием напряжения, пропорционального реальной скорости подвижного звена манипулятора, сравнением его с эталонным и кратковременной запиткой электродвигателя полученной разностью, что обеспечивает необходимую коррекцию скорости, осуществляется без использования датчиков скорости и вычислительного устройства. 2 ил.

1 выводов двигателя соединен с общим проводом, а другой — с переключающимся контактом магнитоуправляемого переключателя. Нормально замкнутый контакт соединен с неинвертирующим входом усилителя 12 и запоминающим элементом 13, выполненным, например, в аиде конденсатора, второй вывод которого соединен с общим проводом. Инвертирующий C) вход усилителя связан с источником 14 эта- (фд лонного напряжения. Выход усилителя сое- (ь) динен с нормально разомкнутым контактом,фь, магнитоуправляемого переключателя.

Устройство управления звеном манипулятора с рекуперацией энергии работает следующим образом.

При отпускании фиксаторов 5 и 7 подвижное звено 1 под действием сжатого упругого элемента 3 приходит в движение.

Траектория его движения разделена на три участка, расположенных симметрично относительно ее середины. На первом участке производится измерение скорости подвиж1710334

30 информации

50 ного звена 1 переключением привода 9 в режим генератора. При этом напряжение противоЭДС приводного двигателя 9 через нормально замкнутые контакты мэгнитоуправляемого переключателя 11 поступает на неинвертирующий вход усилителя 12 и запоминающий элемент 13, выполненный, например, в виде конденсатора. На втором участке траектории срабатывает мэгнитоуправляемый переключатель 11 под действием постоянного магнита 10, закрепленного на подвижном звене 1, и тем самым переключает вывод приводного двигателя 9 к выходу усилителя 12, что приводит к подаче на него управляющего напряжения. Таким образом, привод переводится в режим работы двигателя. На неинвертирующий вход усилителя 12 при этом подается напряжение с запоминающего элемента 13, равное напряжению противоЗДС двигателя в момент переключения, и соответствующее реальной скорости звена 1 в этот момент времени.

На инвертирующий вход поступает напряжение от эталонного источника 14, равное напряжению противоЭДС двигателя при скорости движения звена, соответствующей движению при отсутствии потерь энергии, измеренной,в момент переключения магнитоуправляемого переключателя

11. На двигатель 9, таким образом, поступает управляющее напряжение, пропорциональное разности между эталонной и реальной скоростями звена 1 на момент переключения магнитоупрэвляемого переключателя 11, На третьем„конечном, участке траектории при соответствующем положении звена 1 снова срабатывает магнитоуправляемый контакт 11 и двигатель опять переводится в режим генврэтора. Однако в дальнейшем напряжение противоЭДС двигателя до окончания движения по траектории не используется, Аналогичным образом происходит движение подвижного элемента в противоположном направлении.

Для этого выводы приводного двигателя необходимо поменять местами (схема. реализующая это переключение, на фиг, 2 не показана), Коэффициент усиления усилителя 12 определяется теоретически или экспериментально таким, чтобы подвижное звено 1 переместилось под действием упругих элементов 3 и 4 из одного крайнего положения в другое, зафиксировалось и конечная скорость его стала равна нулю, при изменении момента трения системы. Так, при увеличении, например, трения при движении. звена его реальная скорость снижается и управляющее напряжение, подаваемое на двигатель, возрастает, что приводит к возрастэнию его момента и компенсации увеличения силы трения. Наоборот, при уменьшении трения управляющее напряжение, подаваемое на двигатель, уменьшается, что уменьшает и величину компенсирующего эту силу момента.

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

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

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

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

1710334

Составитель С.Соколов

Техред МЛИоргентал Корректор О.Кравцова

Редактор Н.Яцола

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

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

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

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