Антропоморфный манипулятор

СОЮЗ СОВЕТСКИХСОЦИАЛИСТИЧЕСКИХРЕСПУБЛИК Ы 16468 ПИСАНИЕ ИЗОБРЕТЕН К АВТО ЕЛЬСТВ ГОСУДАРСТВЕ ННЫ И КОМИТЕТПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМПРИ ГКНТ СССР(21) 4717579/08 (22) 11.07.89(46) 07.05,91. Бюл. М 17 (71) Донецкий филиал Государственного проектно-конструкторского и научно-исследовательского института по автоматизации угольной промышленности Типроуглеавтоматизация" (72) П,И,Котенко, Ю.М.Барац, Г.В,Сидоров, А.СЛервых и Г.Е.Иткина(53) 621.229.82 (088.8) (56) Авторское свидетельство СССР 1 Ф 1317800, кл. В 25 Л 9/00, 1985.(54) АНТРОПОМОРФ НЫЙ МАНИПУЛЯТОР (57) Изобретение относится к робототехнике и может, быть исгюльзовано в конструкциях многоцелевых телеуправляемых и программируемых роботов различного назначения. Цель изобретения - повышение точности позиционирования за счет ужесточения конструкции. Для поворота предплечья относительно плеча 1 по сигналу системы управления включаются одновременно первый 16 и второй 19 приводы, жестко установленные на плече, Для поворота кистевого звена останавливают первый привод 16, в требуемом положении и включают второй привод 19; который вращает стойку 9, шарнирно установленную на плече. При этом поворачивается корпус 17 силового цилиндра, шарнирно соединенный с этой стойкой. Шток 18 силового цилиндра взаимодействует сферическим выступом с кулисой 12, которая поворачивает кистевое звено. Одновременно корпус 17 силового цилиндра обкатывается по поверхности кулачка 13, жестко связанного со стойкой, что позволяет компенсировать изменение вра- Я щающего момента, Для наклона кистевого эвеиа включают только силовой цилиндр, шток 18 которого, выдвигаясь из корпуса 17, поворачивает кистевое звено;2 ил.Изобретение относится к области робототехники и может быть использовано в конструкциях многоцелевых телеуправляемых и программируемых роботов различного назначения.Цель изобретения - повышение точности позиционирования за счет ужесточения конструкции.На фиг. 1 представлена схема антропоморфного манипулятора; на фиг; 2 - предплечье манипулятора с кистью и схватом,Антропоморфный манипулятор фиг, 1) состоит из трех звеньев: плеча 1, предплечья 2., кистевого звена 3 со схватом, Приводы 4-6 связывают соответственно плечо с основанием, плечо с предплечьем, предплечье с кистевым звеном, а привод 7 обеспечивает вращение кистевого звена со/ схватом относительно продольной оси О-О манипулятора, Привод 4 поворачивает плечо относительно основания на углы 01 и б, привод 5 поворачивает предплечье относительно плеча на углы Ж и О 4, привод 6 поворачивает кистевое звено относительно предплечья на углы О 6 и 07, привод.7 вращает кистевое звено на угол В 5 относительно оси О-О. Манипулятор имеет систему 8 управления, реализующую команды управления приводами 4-7 и схватом кистевого звена формируемыми известными программными средствами либо многостепенными рукоятками (не показаны) такчто движения звеньев манипулятора. подобны движенлю руки человека,Предплечье антропоморфноо манипулятора имеет стойку 9, первое коромысло 10, второе коромысло 11 и кулису 12. Кулиса 12 соединена с кистью при помощи одно- подвижного приводного механизма, встроенного в кистевое звено не показано), ось/вращения Оз-Оз которого совпадает с осью кулисы, Стойка 9 шарнирно закреплена на плече 1, Ось 02-02 стойки перпендикулярна оси 01-01 плеча. Кулачок 13 жестко связан со стойкой, Первое коромысло 10 состоит из двух звеньев 14 и 15, связанных между собой шарниром, ось вращения которого совпадает с осью 04-04 предплечья манипулятора. Входное звено 14 жестко связано со стойкой 9, а с плечом 1 - при помощи одно- подвижного привода 16, ось вращения которого совпадает с осью 02-02 стойки 9, Звено 15 соединено с кулисой 12 посредством шарнира, ось 05-05 которого перпенди кул я рн а оси Оз-Оз кулисы, Второе коромысло 11 включает одноподвижный приводной механизм возвратно-поступательного перемещения (силовой цилиндр), состоящий из корпуса 17 и штока 18. Корпус 17 связан со стойкой 9 и с одноподвижным 5 приводом 19, ось вращения которого совпадает с осью 02-02 стойки 9, и шарниром с/осью 06-06, перпендикулярной оси 02-02 стойки 9. Шток 18 связан с цилиндрической направляющей кулисы 12 шаровой опорой - 10 сферическим выступом, выполненным наштоке, Профилированная поверхность кулачка 13 контактирует с поверхностью корпуса 7, образуя кулачково-рычажный механизм второго коромысла И, который 15 реализует. заданный закон движения коромысла при его повороте. Приводы 16 и 19 одинаковые по конструкции, Например, привод 19.состоит из пары 20 и 21 однополостных цилиндров, закрепленных на пло щадках 22 плеча 1, со штоками, к которымприкреплена цепь 23, охватывающая звездочку 24, вращающуюся относительно оси 02-02, Звездочка 24 привода 19 жестко связана со стойкой 9, Привод 16 отличается 25 тем, что его звездочка жестко связана с первым коромыслом 10,Манипулятор работает следующим образом.30 Система 8 управления формирует сигналы управления приводами 4-7 плеча, предплечья и кистевого звена со схватом манипулятора, При этом реализуется определенная программа движений звеньев.35 При подаче сигналов на сервоприводы привода 4 осуществляются повороты плеча 1 на углы 01 и 6, При подаче сигналов на привод 5 осуществляются повороты предплечья 2 на углы 5 и%, В частности, поворот 40 предплечья вокруг оси 02-02 осуществляется при одновременйой подаче сигналов управления на приводы 16 и 19. В зависимости от выбранного направления поворота предплечья рабочее тело подается либо в штоко вые полости цилиндров 20, а штоковыеполости цилиндров 21 соединяются со сливом, либо наоборот, При этом коромысла 10 и 11 и стойка 9 с кулачком 13 поворачивают/ся относительно оси 02-02 . Поворот кисти 3 50 на угол О осуществляется следующим образом: в штоковые полости цилиндров 20 и 21 привода 16 подается рабочее тело, чем фиксируется пространственное положение первого коромысла 10; в зависимости от вы бранного направления поворота кисти 3 рабочее тело подается в штоковую полость одного из цилиндров 20 и 21 (при этом штоковая полость второго цилиндра соединяется со сливом) приводного механизма 19, в1646850 оставитель В.Верховскийехред М.Моргентал Коррект сими шинец,Редак Папп Тираж 481 Подписноеенного комитета по изобретениям и открытиям при ГКНТ ССС 13035, Москва, Ж, Раушская наб 4/5 Заказ 1371 ВНИИПИ Государ Производственно-издательский комбинат "Патент", г. од, ул,Гагарина, 101 результате чего осуществляется поворот второго коромысла 11 и одновременно вместе. со связанной с ним кулисой 12 вокруг оси 04-04 первого коромысла 10; одновременно с подачей рабочего тела в цилиндры приводов 16 и 19 осуществляется выдвижение штока 18 привода возвратно-поступательного перемещения второго коромысла 11 для компенсации его укорочения в процессе поворота относительно осей 02-02 и 04-04. Для компенсации изменения вращающего момента, действующего на кистевое звено, корпус 17 второго коромысла 11 обкатывается по профилированной поверхности кулачка 13. Поворот кистевого звена 3 на угол Оэ в зависимости от выбранного направления поворота осуществляется выдвижением или втягиванием штока 18 привода возвратно-поступательного перемещения второго коромысла 11. При этом сферический выступ штока перемещается по цилиндрической направляющей кулисы 12,Поворот кисти 3 на угол Оу осуществляется при подаче сигналов управления на привод 6, сервопривод которого встроен в кисть 3 (не показан). Формула изобретенияАнтропоморфный манипулятор, содержащий плечо, первый и второй приводы, жестко смонтированные на плече, пред-,. 5 плечье, состоящее из входного звена, шарнирно соединенного с плечом и кинематически связанного с первым приводом, и выходного звена, шарнирно соединенного с входным, кистевое звено, 10 шарнирно соединенное с выходным звеном предплечья, а также систему управления, о т л и ч а ю щ и й с я тем, что, с целью повышения точности позиционирования за счет ужесточения конструкции, он снабжен 15 стойкой, жестко связанной с входным звеном предплечья, шарнирно установленной на плече и кинематически связанной с вторым приводом, силовым цилиндром, корпус которого шарнирно закреплен на этой стой ке, а также кулачком, жестко связанным со стойкой и находящимся в контакте с корпусом указанного силового цилиндра, при этом на штоке силового цилиндоа выполнен сферический выступ, имеющий возмож ность взаимодействия с дополнительно введенной кулисой, шарнирно связанной с кистевым звеном,Уу