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

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

Иллюстрации

Показать все

Реферат

 

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

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

Республик

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

G 05 В 11/00

В 25 J 13/00

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

СССР (53) УДК 62-50 (088.8) ао делам изобретений и открытий

Опубликовано 28.02.81. Бюллетень № 8

Дата опубликования описания 10.03.81 (72) Авторы изобретения

В. А. Васильев, Ю. И. Кузьмин, В. В. Шабаршов и . Н. Ядыкин

1 (71) Заявитель (54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ДИСТАНЦИОННЫМ

КОПИРУЮЩИМ МАНИПУЛЯТОРОМ

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

Известен манипулятор, содержащий исполнительный привод, выходной вал которого связан через механические передачи и упругие элементы датчиков нагрузки с валом оператора и валом нагрузки, причем выходы датчиков соединены со входами сумматора, выход которого через усилитель 1о подключен ко входу двигателя (1).

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

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

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

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

25 последовательно соединенные датчик положения задающего органа, привод исполнительного органа и датчик нагрузки исполнительного органа, блок уравновешивания и последовательно соединенные сумматор, привод задающего органа и датчик нагрузки задающего органа, выход которого связан с первым входом сумматор (3).

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

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

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

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

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

Устройство содержит датчик 1 положения задающего органа, датчик 2 нагрузки задающего органа, привод 3 задающего органа, блок 4 уравновешивания, установленные на задающем органе 5, привод 6 исполнительного органа, датчик 7 нагрузки исполнительного органа, акселерометр 8 исполнительного органа, установленные на исполнительном органе 9, объект 10 манипулирования, пульт 11 управления, сумматор 12, блоки 13 — 15 переключения коэффициента и оператора 16. зо

4

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

Оператор 16 перемещает задающий орган 5, изменяя его положение в пространстве. Перемещение 30 преобразуется датчиком 1 положения задающего органа в сигнал управления. Привод исполнительного органа 6 отрабатывает заданное перемещение и исполнительный орган 9 взаимодействует с объектом 10 манипулирования.

Усилия (моменты), возникающие от этого взаимодействия, измеряются датчиком 7 нагрузки исполнительного органа и сигнал нагрузки через блок 13 переключения коэффициента и сумматор 12 поступает на при вод 3 задающего органа, воздействующий через упругий элемент в датчике 2 нагрузки задающего органа на оператора 16 и вызывающий у него ощущения сопротивления, пропорциональные приложенной нагрузке со стороны исполнительного органа 9. Такое соответствие обеспечивается сравнением сигнала управления по нагрузке от блока

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

Исходя из опыта и оценки объекта 10 манипулирования, например, его массы, или из величины ощущаемого оператором усилия, оператор 16 выбирает масштаб отражения усилия нагрузки и устанавливает выбранное значение на пульте 11 управления

Если оператор ощущает незначительное отраженное усилие на 30, он переключает на пульте 11 управления масштаб отражения, при этом по сигналу пульта 11 управления блок 13 переключения коэффициента изменяет коэффициент усиления на входе сумматора таким образом, что при том же сигнале от датчика 7 нагрузки исполнительного органа привод 3 задающего органа развивает большее отраженное усилие на руке оператора 16. Если оператор ощущает черезмерное увеличение нагрузки, действия с пуль том 11 управления производятся в обратном порядке. При этом оператор имеет возможность выбирать для себя оптимальный масштаб отражения нагрузки, исходя из ожидаемой длительности работы и величины нагрузки.

Таким образом, манипулятор становится удобным для работы оператора в составе биотехнической системы человек-машина.

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

Одновременность изменения коэффициентов в блоках 13 и 14 переключения коэффициента обеспечивает равенство по модулю сигнала акселерометра исполнительного

809048

25 зо

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

5 органа 8 и весовой составляющей сигнала датчика 7 нагрузки исполнительного органа на входах сумматора 12. Заметим, что акселерометры в этом случае играют роль измерителей составляющей ускорения свободного падения, создающей весовую нагрузку на исполнительный орган. Ту же задачу выполняет блок 15 переключения коэффициентов, если уравновешивание исполнительного органа 9 производится полностью или частично компенсационным методом с помощью блока 4 уравновешивания, установленного на задающем органе 5. Функция блока уравновешивания, имеющего в своем составе акселерометры и вычислитель, состоит в выработке компенсирующего сигнала с такой же функциональной зависимостью от положения 30, как весовая нагрузка собственно конструкции исполнительного органа от

его положения.

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

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

1О

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

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

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

1. Кубарев Е. И., Кулешов В. С., Пакин А. А. Системы моментной разгрузки и моментного масштабирования в копирующих манипуляторах. Сборник «Теория и устройство манипуляторов», М., «Наука», 1973, с. 72, рис. 1.

2. Кулешов В. С., Лакота Н. А. Динамика систем управления манипуляторами М., «Энергия> 1971, с. 244. рис. 5 — 14.

3. Авторское свидетельство СССР № 275680, кл. В 25 J 3/04, 31.03. 69 (прототип).

809048

Редактор Е. Лушникова

Заказ 10877/52

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

Техред А. Бойкас Корректор Н. Швыдкая

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

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

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

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