Система управления очувствленным манипулятором

Система управления очувствленным манипулятором

Иллюстрации

Показать все

Реферат

 

ОП ИСАНИЕ

ИЗОБРЕТЕНИЯ

Союз Советскнх

Социалнстнческнх

Реслублнк

<1>875332

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (61) Дополнительное к авт. свид-ву— (22) Заявлено 2902о0 (21) 2888349/18 24 с присоединенмем заявим ¹â€” (23) Приоритет

Опубликовано 231081 Бюллетень М 39 (51)М. Кл З

G 05 В 11/00

В 25 J 13/00

Государственный комитет

СССР по делам изобретений и открытий (53) УДК 62-50 (088.8) Дата опубликования описания 23,1081 (72) Авторы изобретения

В.Е.Сметанко, В.В.Сигарева и A. о

I ",">,,,, j

) „ ;, Московское ордена Ленина и ордена/Трудового. Красного;

Знамени высшее техническое учи(пище "йм.Н.Э.Баумана г (71) Заявитель (54) СИСТЕМА УПРАВЛЕНИЯ ОЧУВСТВЛЕННЫМ

МАНИПУЛЯТОРОМ

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

Известна система управления очувствленным манипулятором. содержащая исполнительный и задающий органы, датчик положения, датчик скОрости; блоки управления и приводы, которая не исключает автоколебаний при работе на упор l1) .

Наиболее близкой по технической сущности к предлагаемому является система, содержащая первый датчик положения, механически связанный 15 через первый датчик момента с первым двигателем, вход которого подключен к выходу первого блока управления, первым входом соединенного с выходом первого датчика момента, а 20 также второй датчик положения, механически связанный через второй датчик момента со вторым двигателем, вход которого подключен к выходу второго блока управления, первым входом соединенного с выходом второго датчика положения, а вторым входом - с выходом первого датчика положения 52J .

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

Цель изобретения — повышение точности системы.

Цель достигается тем, что система содержит источник эталонного сигнала, апериодическое звено и последовательно соединенные дифференциатор, блок выделения модуля, компаратор и ключ, второй вход которо;о подключен ко входам апериодического звена и дифференциатора и к выходу второго датчика момента, а выход — к выходу апериодического звена и второму входу первого блока управления, причем вы875332

40 к U

50 М 1"мр14 f i где К вЂ” коэффициент усиления устройства управления двигателем задающего органа °

U - выходной сигнал моментного датчика исполнительного органа; — текущее время;

U - опорное напряжение, ход источника эталонного сигнала соединен со вторым входом компаратора.

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

Система содержит задающий орган

1, первый датчик. 2 положения, первый датчик 3 момента, первый двигатель 4, первый блок 5 управления, исполнительный орган б, второй блок

7 управления, второй двигатель 8, второй датчик 9 момента, второй датчик 10 положения, блок 11 с регулируемой постоянной времени, источник

12 эталонного сигнала, апериодическое звено 13, ключ 14, компаратор 15, дифференциатор 16, блок 17 выделения модуля. 15

Система управления работает следующим образом.

При малой скорости изменения сигнала. второго датчика 9 момента, исполнительного органа б ключ 14 замкнутЩ и сигнал с выхода датчика 9 момента поступает непосредственно на вход первого блока управления двигателем 4.

Если скорость изменения сигнала датчика 9 момента превышает некоторую ве- д личину, определяемую значением опорного напряжения О, происходит срабатывание компаратора 15, ключ размы кается и в цепь между датчиком 9 момента и блоком 5 управления двигателем 4 задающего органа 1 оказывается включенным апериодическое звено 13 с коэффициентом передачи равным единице и постоянной времени Т.

Таким образом, напряжение на дви гателе 4 задающего органа 1, при отсутствии сигнала на выходе первого датчика 3 момента, определяется следующим образом Зо "Ю(-в> ) )vgg) - К вЂ” коэффициент передачи дифференцирующего звена и схемы определения модуля.

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

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

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

Источники информации, принятые во внимание при экспертизе

1. Кулемов В.С., Лакота H.A.

Динамика систем управления манипуляторами. М., "Энергия", 1971,с.211.

2. Кулемов В.С., Лакота H.A. Динамика систем управления манипуляторами. "Энергия", М., 1971, с.243 (прототип) .

875332

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

Техред A Ñàâêà Корректор С.Шекмар

Редактор Г.Волкова

Заказ 9331/72 Тираж 943 Подписное

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

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

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