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

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

Иллюстрации

Показать все

Реферат

 

Изобретение относится к аналоговой вычислительной технике и может найти применение в системах управления манипуляторов и робототехнических систем. Цель изобретения - расширение функциональных возможностей за счет обеспечения управления по декартовым и шарнирным переменным, введения режима согласования выходных сигналов с текущими. Устройство содержит первый и второй блоки коммутаторов 1,2, блок прямого преобразования координат 3, блок суммирования 4, блок умножения на постоянную матрицу 5, первый и второй блоки интеграторов 6, 7, элемент НЕ 8, элемент И 9. Введение первого и второго блоков коммутаторов, второго блока интеграторов, элемента И и элемента НЕ позволяет достичь поставленную цель при малых аппаратурный затратах. 3 ил., 1 табл. СЛ С

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

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

РЕСПУБЛИК (я)5 G 05 В 19/00

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

ПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМ

ПРИ ГКНТ СССР

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

3 ил„1 табл.

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4675081/24 (22) 09.03.89 (46) 15.01.92. Бюл. М 2 (71) Объединение кооперативов "Символ" (72) В.М.Буданов, Е.В,Гурфинкель, Л.Г.Штильман и А,А.Казачков (53) 62-50(088.8) (56) Авторское свидетельство СССР

М 633725, кл, В 25 J 13/00, 1978.

Спецвычислитель для преобразования координат в системе управления искусственной конечностью, — проспект ВДНХ

СССР, 1981, (54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ МАНИПУЛЯТОРОМ ПО ВЕКТОРУ СКОРОСТИ (57) Изобретение относится к аналоговой вычислительной технике и может найти приИзобретение относится к аналоговой вычислительной технике и может. найти при- менение в системах управления манипуляторов и робототехнических систем, Известно устройство, обеспечивающее в независимых от кинематики манипулятора координатах позиционно-скоростное управление и содержащее задающий орган, блок нелинейных преобразователей, блок пороговых элементов, вычислительное устройство, блок изменения структуры системы, исполнительный механизм. При этом в вычислительном устройстве производится преобразование командных сигналов, поступающих с задающего органа, в сигналы, соответствующие шарнирным скоростям манипулятора с помощью якобиана преобБЫ„1705803 А1 менение в системах управления манипуляторов и робототехнических систем. Цель изобретения — расширение функциональных возможностей за счет обеспечения управления по декартовым и шарнирным переменным, введения режима согласования выходных сигналов с текущими. Устройство содержит первый и второй блоки коммутаторов 1, 2, блок прямого преобразования координат 3, блок суммирования 4, блок умножения на постоянную матрицу 5, первый и второй блоки интеграторов 6, 7, элемент НЕ 8, элемент И 9. Введение первого и второго блоков коммутаторов. второго блока интеграторов, элемента И и элемента НЕ позволяет достичь поставленную цель при малых аппаратурнык затратах. и разования, связывающего шарнирные переменные манипулятора с координатами, в которых осуществляется управление.

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

Х1 = (lo +11 з!г1иг + I2 з1п(аг — сиз)) sinai, Хг = (lo + 11в1пс. г + 1г sir1(a2 — с4))сosrri, Хз — 11с0$с:"„ + 1гсоз(Гхг (Х3). (1)

Недост тком указаннь,х устройсте является то, TO OI и «е позволяют управлять отдельнь ми шар1 ирами манипулятора и не обеспечива Ог согласование управляющих сигналов с текущим положением манипулятора в начале раб1.ты В 1ом числе, при Включении питания.

Целью и Обрег 11ия является расширение фу11кц110,1ал1,»1, х 110зможностей устройства за с1ег Обес11 - <ения управле1IHrI llo декартовым . шэр>I!IpHI переменным и введения I 1к1 л1а согласования выходных сигналов устройсT .а с реальным положением манипулч1ора В 1ачале работы и при переходе с управления в прямоугольной си- 25 стеме координат на управление отдельными шарнирами и „братно.

TpxHvlKo-э ономический эффеKT предлагаемого ус ."ой1.г га сост0.1т в существенном упрсп е ни pv ilroro управления манипуг1яц сн:11 .1 сиг;е ами с бол шим числом сте11еней псдВ11жности, B соВмещении сущесгген10 нп;ных режимов рабог 1 при малых лг.парат pliblx затра гах.

Указанная i,ель,1001игается rei, по устООЙСтВЕ Со,", .p::. ii,oo бЛOK op!IIKIOr„:,p;..OÜоаçoвани:, :"Îрднl Т, блoK cpasiloнил, блок умно>к н -1,з no . Гоянн, 01латрицу, первый

o;I0K ин ег11аторop, oi.l:«1д holopoi o яВ lяется Выхоц1. 1з „ с грэ11. Ва, а . 1нфорк1ац 10нн1.1й вход подк 1«ен к ВВ1;Оду блока умножения на постоянн, ю i а pIIII,«вход которого подклю.1е. к .-В1ходу злока сравнения, первый

r:ход к0101>s 0 il .:,Дк K1 сн к Выходу б IOK3 прям01о 11. .Обца, oi «1:ч координат, goiTonнитольно с дорж 1т 1 ерьы1. Второи блоки комму1аторз.,;roi Ой блок ин1егра1ороь элемент И, эле1.с 1г ЧЕ, вход которого подключен 1. У11рав 1110щему Входу Вторoro бл,зКа ИНтЕГРато;ЗОВ и;В .:«ГСЯ ПЕРВЫМ ВХОДОМ

Г0 режима раГс-.ы ус1ройс.гва, а Выход — к первому входу эльмен га!1, Второй Вход которого подклю ен K уг1 равля:Още11у входу первого блока интегра1оров и является втор1 м Входом зада 1ия р жима работы устройства, а 55 выход соедин- н с управляющими входами

nepaoro и В1ор г . блоков коммутаторов, выходы Kolopb. 10д1«ночены соответств нно к входу t:iОoкKа !1p 1 oro rip! Образования координат и к входу задания начальных услоВий второго блока интеграторов, выход которого подключен к второму входу блока сравнения и к входу задания начальных условий первого блока интеграторов, а информационный вход является входом задания скорости изменения переменных устройства, выход первого блока интеграторов подключен к первому информационному входу первого блока коммутаторов, второй информационный вход которого подключен к первому информационному входу второго блока коммутаторов и является входом текущего положения шарниров манипулятора устройства, второй информационный вход первого блока кОммутаторов подключен к выходу блока прямого преобразования координат, при этом блок сравнения выполнен в виде блока сумматоров.

На фиг.1 показана блок-схема устройстВа; на фиг.2 — схема подключения предлагаемого устройства для управления манипулятором, на фиг.З вЂ” пример конкретной реализации блока прямого преобразоВания координат, На фиг.4 приведена таблица, поясняющая изменение структуры связей между блоками устройства в различных режимах работы.

Устройство для управления манипулятором по вектору скорости (фиг.1) содержит первый и второй блоки коммутаторов 1, 2. блок прямого преобразования координат 3, блок суммирования 4, блок умножения на постоянную матрицу 5, первый и второи блоки интеграторов б, 7, элемент НЕ 8, элемент И 9. Устройство имеет два логических входа Р1, Р2 и два информационных входа—

Ко 1, текущего положения шарниров манипулятора Q> и вход задания скорости изменени переменных V. Выходом устройства являются сигналы программного положения шарниров манипулятора. с«.

На фиг,2 представлена схема подключе«!i ll ПРЕДЛаГаЕМОГО УСтРОйСтВа ДЛЯ УПРаВЛЕния манипулятором, содержащая объект управления — манипулятор 10, пульт управления 11 и предлагаемое устройство 12.

Вход текущего положения устройства соединяется с выходами ат датчиков манипуля тора, вход задания скорости изменения переменных — с выходами V пульта оператора, На логические входь1 Р1 и Р2 с пульта поступают сигналы управления режимом работы устройства. При этом вход Р1 (фиг.1) соединен с управляющим входом блока интеграторов 7. а вход P2 — c управляющим входом блока интеграторов 6. Логический

Вход Р1 соединен также со входом элемента

170Г,ВЪ

HF о, вь<ход к<)торого сое)<«::: . с п< пвым входом элемента И 9. Вторс< вх )p э<<в< е» r

9 соединен с пер<)ым логич.:-,:)м вхпт и,« f "2 уСтрОйСтна, а ЕГО ВЫХОД СОЕд ni»oti С уПраВЛЧющими входами блоков коммутаторов 1. 2

Первый вход блока 2 и второй вход блп:;3 1

ПОДКЛЮЧЕНЫ К ВХОду а), ВЫХОЛ бЛОК(r;ItiMY. атОРОВ, < «ЕДИ»Е;«,;Хо., »., 01 мог<1 и р<. Рб()

»а«альных условий б(ока ин Ге<рат .-.

Вь<ход блска 3 прямого преобразов- «<

Орди Одом б«< сум "ntnpof

6 и гс втор,irs в. )дом олоi л с.ó< мир.

4, В <<ХОД КОТОРОГО СОРД<,; НЕ» C. COC)1 t

ВЫХОДОМ . С; Рой(-т .а, Кэ. )ый и-.. б l.

V0t3OI О ЧИСТ< ),lt) I «<а!»ЭЛ ЬНЬ<Х KON <У1 < 0 Н анало<ов.ix c.in!ital!0!. (лх «Incr<0 равнс .10 компонент Г<Рк Горов «.. и r (, соотве Г: <

Ш . РНИРНЫХ УГЛОВ i..аНИП;ЛЯТОРа И 1<РЯ л,4 ГО/1ЬНЬ1Х УОООД<ЬНЭ f ЕГО КОН! Iа. КОММУ ТЗ«0ры <ло: >1 t

Kt 59<<К(17, 8 0» itntn Kop»<л<1утаторэ .. c<3щ L: м >< и р а в tl О<<и . t к 0 т о р ь< е м «,: < и С rl 0 л ь 3 0 Г< <3 т ь к; l«1 « -. )3 в < х к r3 1 а л ь н l :, <; ", л тз Гора. (1»тег(<ЭТЬр1. <)л )к<)< 6, 7 выполн, известной схеме Hd зс»с<ве операциг,,< .о J усилителя с конде»сатором в цепи обр:.-, Нг, связи и перекл10«агелчми на информа .о, ном входе и в>;оде иачальны>, услов i, общим управггяющим 01»гналом, В ка«:-., переключателей может бь<ть при<1енен,.; .; —. ".микросхема 1 .Р5<9<0,<Н7, «то и в блока», 2.

Блок 3 прямо<0 <,påoápàço(3àí!nÿ

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

В зависимоеrn о -ровней первî "«l

t3Topoco лог<лчесKt

Г <)Гла«ОРЛН<1Е (< (<Ми()УРМЫХ ) CТРОИСТВОМ пр Граммны> 3на <енлй н)эрнирных пере1» i!» ь! x «! <«/<< I ln t

" IЛ» I < Р 1 Е . i i <- >. т(. р; ° =. =:-< .. :-.,".<<у б IOKn 1 уСт р и, -< 3 °,.<:.1",;. раба>ть< ) тд<-ль 3ь .,",< Оков

<,),; .1: .,-. кр лб;» -ях <л . > алов (>1 и Р2, .<- <3 <.--,, ", .-.Г-, 1Р«; эб);. <;1

;р:,, л < э>< догг i!3 бл <1, . I.3Îß IМ < Х<< ;<» ЛРЕГС« ТОТ, .б<)3< .=-Н r<=ð t, СтрЕЛКОй На

:, блок )в -» it.;-э<оров б 7 указаны

<с,, И<„« ГР—;. <1 1» .

<« . i 00(.Itt x на входах Р1 <и Р2

:..; () О< - интеграт )ров находятся в ре>ки < 3<Л-") Л« t t;I X <)

,< д.;! 1<»<-; ilò а (»1 9 фор>. .и ру

1-:.В. В СДЭВ . (О; .,Iot». С<лГ<3ЗЛtt Г., ТЕку11< «, и;:ох<ен<л < эрни - Р л знь пуляторз

<> с к < о.:;;. Тат. IOR,) поступают HR .-: д 1-.-" «л<»ых Гч .Ое<л<,> блск » интегра о«<. Эн»<в,1лваю)<ск (с oбоатным знз .-<(1»,, f ro <»<Ода.;

<,-,,. р.l „.,")с<>,1 лрч<сl ся си<нал, ». <.> Ii -:; Рам<<ь<ь<х 3II:. Че<»11>1:,,- <ож" »tnt!

«,; «ь (!!)Г<ЭДЭ<)<Щ<Е С Г. <, B li ЭКОМ РРЖИМЕ

< л«с:; ло- -, х <)с In!.

;;:< ) 1;Е.;;..Мвщвч..;<Г< Из ИСХОДНОi < iI « <»<1Я,, 1 появг,. «Ни вь гс Knro у<) овня гигна-:а i 1 -. ° (In3»< n P.. ()лсч ин;EãpàToðoR 7

Я p:.>K« <4 ИНТРrp!»

<.: -».(<ют; . с 0 сти tn3tneH.,: - <иарнир; .;:еь,<-.«ыx. (1 выходах блока 7 с „..<р",01",ÿ (c, то-<нс.-.гь.:. до знака) прс„аь1

<<

<<

<<<<<

<<<<<

<<<<