Система привода сустава робота на электронных мышцах

СОЮЭ СОВГТСКИХСОЦИАЛИСТИЧЕСКИХРЕСПУБЛИК 5 О ии,Оия: кталов, пропорциератур нагрева ению выходного дает оди озиции пр ГОСУДАРСТВЕННОЕ ПАТЕНТНОВЕДОМСТВО СССРГОСПАТЕНТ СССР) ПИСАНИЕ ИЗОБ К АВТОРСКОМУ СВИДЕТЕЛЬСТ(71) Ленинградский государственный теческий университет(72) А.А,Воронин, С.Г,АграновскЮ,Н.Егоров и И.В,Болотин56) Авторское свидетельство СССРМ 1465317, кл. В 25 ) 1/02, 1987.(54) СИСТЕМА ПРИВОДА СУСТАВА РОТА НА ЭЛЕКТРОННЫХ МЫШЦАХ(57) Использование: в исполнительныхройствах робогов. Сущность изобретесистема привода сустава робота на эл Изобретение относится к машиностроению, а именно к исполнительным устройствам роботов, и может быть использовано как система привода звена робота,Целью изобретения является расширение эксплуатационных возможностей сустава робота.Сущность предлагаемого изобретения состоит в присоединении к антагонистической паре электронных мышц контуров регулирования позиции и силы привода, которые содержат внутренние контуры регулирования токов адсорбентов электронных мышц, а также в присоединении задатчика силы,. управляющего контуром регулирования позиции и силы. связанных с датчиком положения выходного элемента привода - потенциометром и с внешним устройством задания режима работы системы привода сустава робота. Сигнал обратной связи по силе привода формируется как 1815208 А 1 515 В 25 ) 9/08, 9/10, 11/00 ронных мышцах содержит антагонистическую парумышц, контур регулирования позиции привода, контур регулирования силы привода и контуры регулирования таков адсорбентов мышц. Состояние антагонистической пары мышц изменяется в зависимости от команд на входе системы привода, Система находится в режиме отработки заданной позиции, либо ею отрабатывается заданный закон изменения силы. либо имеет место промежуточный режим. Система также содержит комплекс контуров управления положением и усилием привода в сочетании с антагонистической парой электронных мышц, 1 ил. алгебраическая. сумма сиг ональных разности тем электронных мышц и поло элемента привода.Внешнее устройство трех режимов:1. Отработка заданно дом,2. Отработка заданной силы при отсутствии задания на позицию,3. Отработка позиции и силы, одновременно заданных своими диапазонами значений.Задатчик силы в соответствии с пришедшей к нему извне командой начинаетработать в одном из этих трех режимов.По сравнению с известными аналогамизаявляемое устройство благодаря измерению положения выходного элемента привода может быть использовано дляперемещения звена робота по заданному5 10 15 20 25 30 35 40 45 50 55 закону, также благодаря измерению и регулированию силы привода оно может быть использовано для отработки заданного закона изменения силы, создаваемой неподвижным звеном робота и, наконец, заявляемое устройство может быть использовано.для одновременной отработки позиции и силы, заданных зонами своих значений, изменяющимися во времени, это существенно расширяет эксплуатационные возможности управляемого сустава робота.Наличие в заявляемом объекте соединения элементов, которое включает задатчик силы, который состоит из первого и второго ключей и первого сумматора, задатчик токов, который состоит из второго сумматора, первого и второго апериодических звеньев, первого инвертора, третьего сумматора и третьего и,четаертого ключей, контур регулирования тока адсорбента первой электронной мышцы и контур регулирования тока адсорбента второй электронной мышцы, каждый из которых состоит из резистивного делителя, электрических контактов и адсорбента электронной мышцы, датчика тока, содержащего токовый шунт и усилитель, инвертора, сумматора и усилителя, а также первый и второй умножители, третье и четвертое апериодические звенья, второй инвертор, передаточный механизм, потенциометр и третий инвертор, причем первый вход привода соединен с первыми входами первого и второго ключей, второй вход привода соединен со вторым входом первого сумматора, третий вход привода соединен со вторым входом второго ключа, выход первого ключа соединен с первым входом первого сумматора, а выход второго ключа соединен с третьим входом первого сумматора, выход которого соединен с первым входом второго сумматора, выход которого соединен со входами первого и второго апериодических звеньев, выход первого апериодического звена соединен со входом первого инвертара, выход которого соединен с первым входом третьего сумматора, выход второгоапериодического звейа соединен со вторым входом третьего сумматора, выход которого соединен со входами третьего и четвертого ключей, выход третьего ключа соединен с первым входом сумматора контура регулирования .тока адсорбента первой электронной мышцы, а выход четвертого ключа соединен с первым входом сумматора контура регулирования тока адсорбента второй электронной мышцы, причем в каждом контуре регулирования тока адсорбента электронной мышцы выход сумФдатора соединен са входом усилителя, причем выход усилителя соединен с двумя параллельно соединенными электрическими ветвями, одна из которых состоит из реэистивного делителя, другая состоит из последовательно соединенных электрических контактов электронной мышцы, адсорбента и токового шунта, который соединен со входом усилителя датчика тока, выход которого соединен со входом инвертора, выход которого. соединен со вторым входом сумматора контура регулирования тока, второй вход первого ключа соединен с выходом третьего инвертора, вход третьего инвертора и второй вход второго сумматора соединены с выходом потенциометра, третий вход второго сумматора соединен с выходом третьего апериодическога звена, вход которого соединен с выходом первого умно- жителя, первый вход которого соединен с выходом усилителя датчика тока адсорбента первой электронной мышцы, а второй вход первого умножителя соединен с выходом резистивного делителя, четвертый вход второга сумматора соединен с выходом второго инвертора, вход которого соединен с выходом четвертого апериодического звена, вход которого соединен с выходом второго умножителя, первый вход которого соединен с выходом усилителя датчика тока адсорбента второй электронной мышцы,второй вход второго умножителя соединен с резистивным делителем второй электронной мышцы, а передаточный механизм механически соединен с первой и второй электронными мышцами и с потенциометром, является совокупностью новых признаков, неизвестных из каких-либо источников информации.На чертеже изображена схема системы привода сустава робота на электронныг мышцах.Заявляемая система привода сустава робота на электронных мышцах гфиг 1) содержит задатчик силы, состоящий из ключей 1 и 2 и сумматора 3, задатчик токов, состоящий из сумматора 4, апериодических звеньев 5 и 6, инвертора 7, сумматора 8, ключей 9 и 10, контур регулирования тока адсорбента электронной мыщцы 11, состоящий из адсорбента 12, электрических контактов 13.1, 13.2, токового шунта 14, усилителя датчика тока 15, инвертора 16, сумматора 17, усилителя 18, контур регулирования тока адсорбента электронной мышцы 19, состоящий из адсорбента, электрических контактов, токового шунта 20, усилителя датчика тока 21, инвертора 22, сумматора 23, усилителя 24, а также резистивные делители 25, 26 и 27, 28 умножители 29 и 30. апериодические звенья 31 и 32, инвертор 33, и инвертор 34, ггередаточный механизм 35 и патенциомегр 36. На10 15 20 выход которого соединен с входами апериодических звеньев 5 и 6, выход апериодического звена 5 соединен с инвертором 7, 25 9 и 10, выход ключа 9 соединен с первым 30входом сумматора 17, выход ключа 10 соединен с первым входом сумматора 23, вы- . фиг. 1 обозначено: Оо - сигнал задания силы привода. О 1 - сигнал задания положения выходного элемента привода, ОО - сигнал отпирания ключей 1 и 2 при О 1 Ф О, 1 - положение выходного элемента привода, Оп - напряжение на выходе потенциометра,Электронные мышцы 11 и 19 идентичны. Каждая электронная мышца содержит электрические контакты 13.1, 13.2, анизотропную оболочку 37, эластомерную оболочку 38, адсорбатный наполнитель 39, адсорбент 12, Вход привода, на котором действует сигнал Об, соединен с первыми входами ключей 1 и 2, вход привода для задания силы привода соединен с вторым входом сумматора 3, вход привода для задания положения выходного элемента привода соединен с вторым входом ключа 2, выход ключа 1 соединен с первым входом сумматора 3, а выход ключа 2 соединен с третьим входом сумматора 3, выход которого соединен с первым входом сумматора 4,выход которого соединен с первым входом сумматора 8, выход апериодического звена 6 соединен со вторым входом сумматора 8, выход которого соединен с входами ключей ход сумматора 17 соединен с входом усилителя 18, выход которого соединен с двумя параллельно соединенными электрическими цепями, одне из которых состоит из резистивного делителя 25 и 26, другая состоит из последовательно соединенных , электрических контактов 13.1, 13.2, адсорбента 12 и токового шунта 14, соединенного с входом усилителя датчика тока 15, выход которого соединен со входом инвертора 16 выход которого соединен с вторым входом сумматора 17, выход сумматора 23 соединен с входом усилителя 24, выход которого соединен с двумя параллельно соединенными электрическими цепями, одна из которых состоит из резистивного делителя 27 и 28, другая состоит из последовательно соединенных электрических контактов, адсорбента электронной мышцы 19 и токового шунта 20, соединенного с входом усилителядатчика тока 21, выход которого соединен с входом инвертора 22, выход которого соединен со вторым входом сумматора 23, второй вход ключа 1 соединен с выходом инвертора 34, вход инвертора 34 и второй вход сумматора 4 соединены с выходом потенциометра 36, третий вход сумматора 4 соединен с выходом апериодического зве 35 40 45 50 55 на 31, вход которого соединен с выходом умножителя 29, пеовый вход которого соединен с выходом усилителя датчика тока 15, второй вход умножителя 29 соединен с выходом резистивного делителя 25 и 26, четвертый вход сумматора 4 соединен с выходом инвертора 33, вход которого соединен с выходом апериодического звена 32, вход которого соединен с выходом умножителя 30, первый вход которого соединен с выходом усилителя датчика тока 21, второй вход умножителя 30 соединен с выходом резистивного делителя 27 и 28, а передаточный механизм 35 механически соединен с электронными мышцами 11 и 19 и с потенциометром 36.Ключ 9, соединенный с сумматором 17 контура регулирования тока адсорбента электронной мышцы 11, пропускает только входной сигнал, имеющий потенциал положительной полярности, Ключ 10, управляющий сумматором 23 контура регулирования тока адсорбента электронной мышцы 19, пропускает только входной сигнал отрицательной полярности. Ключи 9 и 1 О другими сигналами не управляются,Система привода сустава робота на электронных мышцах, схема которой изображена на чертеже, работает следующимобразом.От внешнего устройства задания режима работы системы привода поступают воздействия: О 1, Од и Оа. Если Ос=0 то на выходе сумматора 3 действует сигнал для первого режима:Оз=К 1 х (О 1 Оп),где сигнал Ол снимаемый с выхода потенциометра 36(фиг, 1),пропорционален положению выходного элемента привода, К 1=сопз 0, В этом режиме происходит отработка приводом заданной позиции;Од=1, ключи 1 и 2 открыты,Если 01=0, то на выходе сумматора 3 получаем сигнал:Оз=К 2 х Оа,где К 2=сопзт 0. Это второй режим. Ему соответствует отработка заданного закона изменения силы привода, Оу-О. Ключи 1 и 2 заперты.В третьем режиме при О 1 ФО и Оа Ф 0 получаемОз=К 1 х (О 1-Оп)+К 2 х Оа,При этом Од 1, ключи 1 и 2 открыты.С помощью сумматора 4 (фиг. 1) складываются сигнал задания силы (первый вход) и сигналы, сумма которых пропорциональна силе привода со знаком минус (остальные входы). 5Сила развиваемая приводом, равна: 0=-Кз х (К 4 х (Т 2 - Т 1)+) где Т - температура нагрева первой элект-. 10ронной мышцы;Т 2 - температура нагрева второй электронной мышцы;- положение выходного элемента привода, 15Кз, К 4-положительные коэффициенты,Сила, развиваемая одной эластичноймышцей определяется по закону Гука, какразность между длиной ненагруженноймышцы и ее реальной длиной, Для антагонистической пары мышц Кз - коэффициентжесткости пары мышц, а разность температур определяет их ненагруженное состояние,Уравнение температуры Т 1: 25 Т 1+7 - = 1 01дТ 1бт Уравнение температуры Т 2: 30 Т 2 + т -- 2 02б Т 2д 1 Здесь т- тепловая постоянная элект ронной мышцы, 1 - ток адсорбента первой электронной мышцы, 2 ток адсорбента второй электронной мышцы, 01 - напряжение, пропорциональное напряжению подаваемому на сорбент первой электронной мыш цы. 02 - напряжение, пропорциональное напряжению подаваемому на сорбент второй электронной мышцы, 1 - время. К 6(Я)= -- . Кв 0 1+ Ь 16. произведению 202.пропорционален сигналвыхода умножителя 30, Сигнал выхода апериодического звена 31 пропорционалентемпературе Т 1,Сигнал выхода апериодического звена 32 пропорционален температуре Т 2,Сигнал выхода сумматора 4 преобразуется апериодическими звеньями 5, 6. Первое апериодическое звено 5 (см. фиг. 1) 55имеет передаточную функцию: Второе апериодическое звено 6 (см.фиг. 1) имеет передаточную функцию:К 6(З)= +, К,0. К 6 1+ЯМ Здесь Я - параметр преобразования Лапласа;К 6, К 6 коэффициенты передачи; 16 и т 6 постоянные времени, причем 1616 К 61. Настройка коэффициентов К 6, К 6 и постоянных времени В, С 6 производится с целью получения интенсивного изменения токов адсорбентов электронных мышц в начальной.части переходного процесса системы привода и плавного изменения - в конечной части процесса,Заявляемая система привода была реализована на операционных усилителях 544 УД 2 А. Приведенные формулы определяют основные теоретические положения системы привода, и могут быть математически строго доказаны, реальные настройки определяются динамическими диапазонами контуров прямого усиления и обратной связи,Формула изобретения Система привода сустава робота на электронных мышцах, образующих антагонистическую пару, в которой каждая из мышц содержит анизотропную и эластомерную оболочки, адсорбатный наполнитель и адсорбент с герметично выведенными за оболочки электрическими контактами, о т л и ч а ю щ а я с я тем, что, с целью расширения технологических возможностей сустава, она дополнительно содержит задатчик силы, который состоит из первого и второго ключей и первого сумматора, задатчик токов, который состоит иэ второго сумматора, первого и второго апериодических звеньев, первого инвертора, третьего сумматора и третьего и четвертого ключей, контур регулирования тока адсорбента первой электронной мышцы и контур регулирования тока адсорбента второй электронной мышцы, каждый из которых состоит из резистивного делителя, электрических контактов и адсорбента электронной мышцы, датчика тока, содержащего. токовый шунт и усилитель, инвертора, сумматора и усилителя, а также первый и второй умножители, третье и четвертое апериодические звенья. второй инвертор, передаточный механизм. потенциометр и третий инвертор. причем первый вход привода соединен с первыми входами первого и второго ключей, второй; вход привода соединен с вторым входом первого сумматора, третий вход привода со 1815208единен с вторым входом второго ключа, выход первого ключа соединен с первым входом первого сумматора, а выход второго ключа соединен с третьим входом первого сумматора, выход которого соединен с пер вым входом второго сумматора, выход которого соединен с входами первого и второго апериодических звеньев, выход первого апериодического звена соединен с входом первого инвертора, выход которого 10 соединен с первым входом третьего сумматора, выход второго апериодического звена соединен с вторым входом третьего сумматора, выход которого соединен с входами третьего и четвертого ключей, выход треть его ключа соединен с первым входом сумматора контура регулирования тока адсорбента первой электронной мышцы, а выход четвертого ключа соединен с первым входом сумматора контура регулирования 20 тока адсорбента второй электронной мыщцы, причем в каждом контуре регулирования тока адсорбента электронной мышцы выход сумматора соединен с входом усилителя, причем выход усилителя соединен с 25 двумя параллельно соединенными электрическими ветвями, одна из которых состоит из реэистивного делителя, другая состоит иэ последовательно соединенных электрических контактов электронной мыщцы, ад сорбента и токового шунта, который соединен с входом усилителя датчика тока, выход которого соединен с входом инвертора, выход которого соединен с вторым входом сумматора контура регулирования тока, второй вход первого ключа соединен с выходом третьего инвертора, вход третьего инвертора и второй вход второго сумматора соединены с выходом потенциометра, третий вход второго сумматора соединен с выходом третьего апериодического звена, вход которого соединен с выходом первого умно- жителя, первый вход которого соединен с выходом усилителя датчика тока адсорбента первой электронной мышцы, а второй вход первого умножителя соединен с выходом резистивного делителя, четвертый вход второго сумматора соединен с выходом второго инвертора, вход которого соединен с выходом четвертого апериодицеского звена, вход которого соединен с выходом второго умножителя, первый вход которого соединен с выходом усилителя датчика тока адсорбента второй электронной мыщцы, второй вход второго умножителя соединен с резистивным делителем второй электронной мышцы, а передаточный механизм механически соединен с первой и второй электронными мышцами и с потенциометром.1815208 Составитель В.СмеховРедактор Г,Бельскэя 1 ехред 1 Л.Моргенпэл Корректор М Самборска ри ГКНТ СССР П я о и 3 еодст вен н г акаэ 1615 ВНИИПИ Ти ряхк Подписноесударсгленного комитегэ но изобрс,гениям и откриьи,113 г)35 ко,ква. 4, Г, Рлушсная наб 4/5 ьь, зий ог винят 1 зтенз, г Ук .рад,л Г ээдина 101