Манипулятор

 

0 П И С А H И Е 27I252

ИЗОБРЕТЕНИЯ

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

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

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

Ресаублии

Зависимое от авт. свидетельства ¹

Кл. 49с, 30/02

Заявлено 13.Ч.1969 (№ 1334865/25-8) с присоединением заявки №

МПК В 25j 3/04

УДК 621-229.72-872.7:

:658.515(088.8) Приоритет

Опубликовано 12 Ч.1970. Бюллетень ¹ 17

Дата опубликования описания 12.VII I.1970

Комитет ао делам изобретений и открытий ари Совете Министров

СССР

Авторы изобретения

Заявитель

А. Е. Кобрииский, В. И. Сергеев, Ю. А. Степаненко и Л.. Тывф Д

Государственный научно-исследовательский институт маши фещи е, . щ р я

МАН И П УЛ ЯТОР

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

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

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

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

На фиг. 1 изображена кинематическая схе»а исполнительного механизма; на фиг. 2— исполнительный механизм манипулятора; на фиг. 3 — задающий механизм; на фиг. 4 рукоятка задающего механизма; на фиг. 5—

1О блок-схема манипулятора.

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

«запястье» 3 и схват С. В качестве приводов могут быть использованы любые двигатели, например гидроцилиндры ГПИР-О, 1, 2, 8, 4,5, 20 б с реечной или цепной передачей. Каждый гидравлический привод снабжен гидроусилителем, питающимся от напорной магистрали.

Гпдроусилителп приводов ГПИР-О, ГПИР-1 и

ГПИР-2 должны быть выполнены с обратной

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

30 датчиками, например, реостатными.

РД = R „

РД= Л,„РД =R, РД = R„, ÐÄ = R-ь.

РД= Я„„

15

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

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

По направляющим основаниям 1 перемещается каретка 2 упругой подвески. Каретка связана с основанием также при помощи упругого элемента 8 (пластины или мембраны) с тензодатчиком ТД-Z. К каретке крепятся упругие элементы 4 и б (пластины), соединенные последовательно посредством кронштейна б и снабженные тензодатчиками ТД- У и ТД-Х.

Все упругие элементы выполнены таким образом, что имеют невысокую жесткость только в одном из направлений, т. е. для определенного вида нагрузок. Кронштейн 7 первой карданной подвески на оси 8 несет поворотную вилку 9, которая сама является основанием, на котором укреплена ось 10 поворотной вилки

11. Относительные перемещения вилок 9 и 11 реализуются при помощи червячных механизмов с электроприводами МПЗУ-О и МПЗУ(1+2) и измеряются реостатными датчиками

РД-R ° и РД-R ° ° . Поворотная вилка

so VI " -;2

12 второй карданной подвески укреплена осью

18 на поворотной вилке 11. Рычаг 14 посредством оси 15 укреплен на поворотной вилке

12. Перемещение вилки 12 и рычага 14 измеряется реостатными датчиками РД-R ° и т3

РД-R . Рукоятка, осью и основанием кото 4 рой служит рычаг 14, состоит из втулки 1б, укрепленной при помощи упругих пластин 17 на рычаге 14, втулки 18, связанной с втулкой

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

21 связан с втулкой 18 упругим элементом 28, выводящим зуб рычага 21 из контакта с втулкой 1б. Упругие пластины 17 снабжены тензодатчиками ТД-а. Относительное расположение губок управления схватом 20 измеряется при помощи реостатного датчика РД-К

;и

В предлагаемом манипуляторе применено астатическое управление (управление скоростью) перемешениями точки 3 («Запястье») исполнительного механизма и позиционное управление ориентацией оси схвата. Поворот схвата вокруг собственной продольной оси осуществляется независимой системой астати45

65 ческого управления, а управление перемещениями губок схвата — независимое позициочное.

Рассмотрим реализацию астатического управления в предлагаемом манипуляторе.

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

Обозначим через Х, Y, Z — компоненты силы воздействия, проходящей через точку А пересечения осей вилок. Информацию об этих компонентах нагрузки дают датчики ТД-Х, ТД-Y и ТД-Z. Дальнейшая задача заключается в том, чтобы обеспечить такую скорость перемещения точки 3, компоненты которой Х, У, Л были бы пропорциональны величинам компонент нагрузок, Х, Y, Z, т. е. необходимо обеспечить

Х = КХ, У+ = КУ, Z = К .

К вЂ” коэффициент пропорциональности.

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

К (Y cos у, — Xsin y,)

9o=

I, sin yy + lg sin ((g) + $ ) ((Хсоз q,+ Уsin«,(зш(;. +«)+

К

1,sing, + Zcos(y, + «,)(; ((Хсоз,+ Ysin,I ><

К

l„l2 sin 2

X (1, sin р, + 1, sin (р, + р,)(+

+ Z (1, соз р, + 1 соз (р, + y,)I(.

При этом, как показано на блок-схеме, на входы вычислительного устройства подаются сигналы КХ, К), f(Z, а также сигналы, пропорциональные величинам углов сро, ср, ср, с выхода вычислительного устройства снимаются сигналы, величины которых пропорциональны требуемым угловым скоростям сро, <р> и ср, и подаю ся на входы гидроусилителей приводов ГПИР-О, ГПИР-1, ГПИР-2. Реализация определенных выражений (1) скоростей соответствующими регулируемыми приводами исполнительного механизма ГПИР-О, 1, 2 обеспечивает одинаковую направленность и пропорциональность вектора нагрузки (Х, Zj на задающей рукоятке и вектора линейной скорости запястья 3 исполнительного механизма (Л, Y, Z).

Рассмотрим теперь позиционное управление ориентацией оси схвата исполнительного ме-. ханизма в пространстве, OHO включает в себя две «прямые» следящие системы и две «об ратные» следящие системы.

271252

Задачей «обратных» следящих систем является такое перемещение вилок 9 и 11 первой карданной подвески задающей рукоятки, чтобы ось 13 вилки 12 второй карданной подвески задающего устройства была коллинеарна оси предплечья, т. е. прямой ЛЗ, исполнительного механизма манипулятора.

С этой целью одна из «обратных» следягцих систем, содержащая привод МПЗУ-О и датчики РД-R ° и РД-К.-„, призвана отслеживать

-.О на задающем механизме поворотом вилки 9 угол поворота исполнительного механизма манипулятора — с,. Вторая «обратная» следяшая система, содержащая привод МПЗУ- (1+ 2), датчики РД-R, РД-R,, РД-R u

":1+ 2 сумматор сигналов датчиков РД-Р. =, и

РД-R»,, призвана отслеживать на задающем механизме поворотом вилки 11 угол поворота предплечья ЛЗ исполнительного механизма в базовой плсскос ги ПЛЗ, т. е. угол rp< + rp.

Задачей «прямых» следящих систем являегся такое относительное перемещение элементов исполнительной руки, осуществляемое приводами ГПИР-3 и ГПИР-4, чтобы обеспечить коллинеарность оси схвата исполнительный руки и оси рукоятки 15 задающего устройства.

В соответствии с этой задачей первая «прямая» следящая система, содержащая привод

ГПИР-3 и датчики РД-R ° и РД-R,, произз водя ротацию запястья исполнительной руки, обеспечивает параллельность оси шарнира 3 и оси 14 поворотного рычага 15 задающего механизма.

Вторая «прямая» следящая система, содержагцая привод ГПИР-4 и датчики РД-R ° и

V4

РД-R .. отслеживает на исполнительном механизме угол, задаваемый относительным положением элементов 12 и 14 задающего устройства.

Система позиционного управления положением губок схвата исполнительного механизма содержит реостат РД-R ° задающего меха-. и низма и привод перемещения губок схвата исполнительного механизма ГПИР-б с потенциометром РД-R.,- Система астатического управления вращением схвата вокруг собственной продольной оси содержит датчики ТД-ь, привод вращения схвата исполнительного механизма ГПИР-5. Гидроусилитель этого привода также должен иметь обратную связь по расходу жидкости.

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

Оператор создает усилие на задающей рукоятке, в соответствии с которым перемещается запястье 3 исполнительного механизма.

Одновременно на первой двойной поворотной подвеске отрабатываются углы р, и (рг+ q>) в виде углов q. и (q. + Ip ). Фиксируемое или изменяемое оператором положение оси задаюшей рукоятки в пространстве приводит при изменении углов первой карданной подвески к изменению углов во второй (qp и q,4) подвеске, которые и отрабатываются соответствующими приводами исполнительного механизма.

При необходимости повернуть схват исполнительного механизма вокруг его продольной оси оператор наткимает на рычаг с зубом, фиксируя тем самым относительное положение втулок 16 и 18. Прикладывая при этом момент к втулке 18 относительно ее продольной оси, оператор нагружает пластины 17. В соответствии с сигналами датчиков ТД-а приводится во вращение привод поворота схвата вокруг его продольной оси ГПИР-5.

В качестве вычислительного устройства могут быть использованы известные универсальные аналоговые вычислительные машины.

Предмет изобретения

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

2. Манипулятор по п. 1, от гичающийся тем, что рукоятка задающего механизма снабжена двумя соосными втулками, одна из которых при помощи упругих элементов с датчиками усилия, используемыми в системе управления скоростью вращения схвата вокруг его продольной оси, соединена с выходным звеном второй карданной подвески, а вторая, на которую непосредственно воздействует оператор, выполнена с возможностью поворота относительно первой, и подпружиненным рычагом, обеспечивающим относительную фиксаЦИЮ ВТ IOÊ.

271352

Исаолнительнам рума

1 ! ! !

I

I

I ! ! ! Риг 5

Составитель В. Тупицына

Редактор Т. А. Киселева Техред А. А, Камышникова Корректор Н. А. Митрохина

Заказ 2191/19 Тираж 480 Подписное

UHHHIIH Комитета по делам изобретений и открытий при Совете Министров СССР

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

Типография, пр. Сапунова, 2