Устройство для управления дистанционным манипулятором
УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ДИСТАНЦИОННЫМ МАНИПУЛЯТОРОМ по авт. св. СССР № 582960, отличающееся тем, что, с целью повышения точности и улучшения динамических характеристик устройства, введены последовательно соединенные нелинейный блок и блок умножения, через который выход первого сумматора подключен к входу усилителя , а вход нелинейного блока соединен с выходом датчика давления. (Л со со со о 00
СОЮЗ СОВЕТСКИХ
СОЦИАЛИСТИЧЕСКИХ
РЕСПУБЛИК
„„Я0„„1033308 A з(5 В 25 1 11/00; G 05 В 11/00
ГОСУДАРСТВЕННЫЙ КОМИТЕТ СССР
ПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТКРЫТИЙ
ОПИСАНИЕ ИЗОБРЕТЕНИЯ
К А BTOPCHOMV СВИДЕТЕЛЬСТВУ --"жг - -„, ., к (61) 582960 (21) 3411557/18-24 (22) 22.03.82 (46) 07.08.83. Бюл. № 29 (72) В.П. Березкин и Е.Н. Ефремов (53) 62-50(088.8) (56) 1. Авторское свидетельство СССР № 582960, кл. В 25 J 11/00, 1976 (прототип) (54) (57) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ДИСТАНЦИОННЫМ МАНИПУЛЯТОРОМ по авт. св. СССР № 582960, отличающееся тем, что, с целью повышения точности и улучшения динамических характеристик устройства, введены последовательно соединенные нелинейный блок и блок умножения, через который выход первого сумматора подключен к входу усилителя, а вход нелинейного блока соединен с выходом датчика давления.
1033308
1 7ъых
+ax
Изобретение относится к робототехнике и может быть использовано при создании очувствленных дистанционных копирующих манипуляторов.
По основному авт. св. № 582960 известно устройство для управления дистанционным манипулятором, содержащее последовательно соединенные электропривод, упругий элемент и датчик момента, датчик угла задающего органа, последовательно соединенные первый сумматор, усилитель, гидропривод и датчик давления, выход которого подключен к входу первого сумматора, а также последовательно соединенные датчик для исполнительного органа и второй сумматор, выход которого через последовательно соединенные электропривод и датчик угла задающего органа подключен к второму входу второго сумматора, второй выход гидропривода соединен с входом датчика угла исполнительного органа, а выход датчика момента подключен к второму входу первого сумматора.
Недостатком этого устройства является нестабильность статических характеристик очувствления и динамических характеристик гидропривода. Это обусловлено тем, что передаточный коэффициент контура гидропривода (его добротность по скорости) нелинейно зависит от момента, действующего со стороны нагрузки исполнительного органа.
При отсутствии момента нагрузки передаточный коэффициент гидропривода по скорости максимален, а по. мере увеличения момента нагрузки он уменьшается и в пределе становится равным нулю, что при водит к значительному увеличению ошибки очувствления. Изменение этого коэффициента изменяет и динамические характеристики, в частности, изменяет колебательность переходных процессов в контуре гидропривода, замыкаемого по координате перепада давления.
Целью изобретения является повышение точности и улучшение динамических характеристик устройства.
Поставленная цель достигается тем, что в устройство введены последовательно соединенные нелинейный блок и блок умножения, через который выход первого сумматора подключен к входу усилителя, а вход нелинейного блока соединен с выходом датчика .давления.
На чертеже представлена функциональная схема предлагаемого устройства.
Устройство содержит усилитель 1, гидропривод 2, датчик 3 угла исполнительного органа, первый сумматор 4, электропривод
5, упругий элемент 6, датчик 7 момента, второй сумматор 8, датчик 9 давления, датчик 10 задающего органа, оператор 11, исполнительный орган 12, нелинейный блок 13, блок 14 умножения.
1О
Устройство работает следующим образом.
Перемещая задающий орган по желаемой траектории оператор 11 воздействует на упругий элемент 6. Датчик 7 момента замеряет деформацию упругого элемента 6, т.е. вырабатывает сигнал, пропорциональный силовому воздействию оператора 11.
Этот сигнал поступает на первый вход первого сумматора 4, а на второй вход сумматора 4 с датчика 9 давления поступает сигнал, пропорциональный силовому взаимодействию исполнительного органа 12 и его нагрузки. Разностный сигнал с выхода первого сумматора 4 подается через блок
14 умножения и электронный усилитель на вход гидропривода 2. Под действием этого сигнала исполнительный орган !2 перемещается по задаваемой оператором 1 траектории. Электропривод 5 осуществляет слежение задающего органа за исполнительным органом 12 под действием разностного сигнала, снимаемого сумматора с второго сумматора 8, пропорционального разности угловых положений выходных валов гидропривода 2 и электропривода 5.
Назначение блока 14 умножения — стабилизировать коэффициент передачи гидропривода 2 с использованием информации о моменте нагрузки гидропривода 2, снимаемой с датчика 9 давления. Так, при увеличении момента нагрузки на гидропривод, 2 увеличивается сигнал с выхода датчика 9 давления. Этот сигнал, проходя через нелинейный блок 13, увеличивает коэффициент передачи блока 14 умножения по второму входу для того, чтобы не допустить уменьшения общего передаточного коэффициента из-за уменьшения коэффициента передачи гидропривода 2.
Нелинейный блок 13 имеет следующую зависимость выходного напряжения от входного выходное напряжение. блока 13; коэффи циенты пропорциональности; входное напряжение блока 13, пропорциональное перепаду давлений в полостях силового гидроцилиндра привода.
Указанная нелинейная зависимость может быть легко реализована путем кусочнолинейной аппроксимации на интегральных операционных усилителях и диодных цепочках. При уменьшении момента нагрузки сигнал датчика 9 давления, пройдя через нелинейный блок 13, уменьшает коэффициент
3 передачи блока 14 умножения входу, поддерживая неизменным фициент передачи.
1033308
4 по второму Применение изобретения повыи ает точобщий коэф- ность и улучшает динамические характеристики устройства.
Составитель Г. Нефедова
Редактор Т.Мнтейко Техред И. Верес Корректор Г. Решетник
Заказ 5524/i 5 Тираж l 081 Подписное
ВНИИПИ Государственного комитета СССР по делам изобретеннй н открытий
113035, Москва, Ж вЂ” 35, Раушская наб., д. 4/5
Филиал ППП «Патент», г. Ужгород, ул. Проектная, 4
