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

 

УПРАВЛЕНИЯ ДИСТАНЦИОННЫМ МАНИПУЛЯТОРОМ по авт. св. № 582960, отличающееся тем, что, с целью повышения точности устройства, оно содержит блок выделения модуля и последовательно соединенные нелинейный элемент и блок умножения , выход которого подключен к третьему в.ходу второго сумматора, а второй вход - к выходу блока выделения модуля, соединенного входом с пыходом датчика момента, а вход нелинейного элемента подключен к выходу первого сумматора. (Л ю /f f 1 а: 00 J оо со ел J Ю 8

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

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

РЕСПУБЛИН дц 4

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

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

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

ПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТНРЫТИЙ (61) 582960 (21) 3702106/24-24 (22) 09.02.84 (46) 23.07.85. Бюл. № 27 (72) В. П. Березкин, Л. М. Левшин, А. В. Никитин и В. Ф. Суслов (53) 62-50(088.8) (56) Авторское свидетельство СССР

¹ 582960,,кл. В 25 1 11/00, 1976. (54) (57) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ДИСТАНЦИОННЫМ МАНИПУ„„gg„„1168895 А

ЛЯТОРОМ по авт. св. № 582960, отлачаюи ееся тем, что, с целью повышения точности устройства, оно содержит блок выделения модуля и последовательно соединенные нелинейный элемент и блок умножения, выход которого подключен к третьему входу второго сумматора, а второй вход — к выходу блока выделения модуля, соединенного входом с выходом датчика момента, а вход нелинейного элемента подключен к выходу первого сумматора.

1168895

Составитель Г. Нефедова

Техред И. Верес Корректор А. Обручар

Тираж 863 Подписное

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

1 13035, Москва, Ж вЂ” 35, Раушская наб., д. 4/5

Филиал ППП <<Патент», г. Ужгород, ул. Проектная, 4

Редактор С. Саенко

Заказ 4611/40

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

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

На чертеже представлена блок-схема предлагаемого устройства.

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

5, упругий элемент 6, датчик 7 момента, второй сумматор 8, датчик 9 давления, датчик 10 угла задающего органа, пульт 11 управления оператора, исполнительный орган 12, нелинейный элемент 13, блок 14 выделения модуля, блок 15 умножения, электрогидроусилитель 16.

Устройство работает следующим образом.

При проведении рабочих операций оператор с пульта 11 управления воздействует на упругий элемент 6. Датчик 7 момента замеряет деформацию упругого элемента 6, т. е. вырабатывает сигнал, пропорциональный силовому воздействию оператора, который через блок 14 выделения модуля поступает на второй вход блока !5 умножения, управляя его коэффициентом передачи н зависимости от усилия управления, а также на первый вход первого сумматора 4, на второй вход которого подается сигнал с датчика 9 давления, пропорциональный силовому воздействию исполнительного органа 12 и его нагрузки.

Разностный сигнал с выхода первого сумматора 4, который в установившемся режиме пропорционален скорости движения исполнительного органа 12, управляет через усилитель 1 и электрогидроусилитель 16 гидроприводом 2. Одновременно этот разностной сигнал поступает на вход элемента 13, который формирует сигнал, пропорциональный входному, с учетом величины сухого трения, действующего в электроприводе 5 задающего органа, и имеет зависимость выходного напряжения от входного

К U. +Ü при U. )0

11вых=

К U- — Ь при U.x(0, где U-.. — выходное напряжение нелинейного элемента 13;

K — коэффициент пропорциональности;

U. — входное напряжение нелинейного

10 элемента 13;

b — начальное смещение, пропорциональное величине сухого трения в электроприводе 5.

С выхода нелинейного элемента 13 сигнал через блок 15 умножения поступает на третий вход второго сумматора 8, где он суммируется с сигналом, пропорциональным угловому положению выходного вала гидропривода 2, измеряемому с помощью датчика 3 угла, сигнал с которого подает2п ся на первый вход второго сумматора 8.

Электропривод 5 осуществляет слежение задающего органа за движением исполнительного органа 12 под действием сигнала, поступающего с выхода второго сумматора 8, пропорционального разности угловых положений выходных валов гидропривода 2 и электропривода 5, угловое положение которого измеряется с помощью датчика 10 угла, сигнал с которого поступает на второй вход второго сумматора 8, и сигнала с выхода блока 15 умножения, компенсирующего влияние сухого трения в электроприводе 5 и усилия управления со стороны оператора на точность копирования задающим органом движения исполнительного органа 12.

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