Система управления антропоморфным роботом и способ управления

Изобретение относится к области робототехники. Технический результат - расширение функциональных возможностей робота. Система управления содержит компьютер, размещенный в корпусе робота, с установленными на нем предварительно обученными нейронными сетями, систему технического зрения, состоящую из телекамер, установленных на голове робота, и блока обработки видеосигналов. Тактильные датчики расположены на внутренних поверхностях кистей робота и соединены с входами микроконтроллера. Световой маячок размещен на указательном пальце одной из кистей робота. Способ управления включает предварительное обучение трех нейронных сетей на выполнение задач, связанных с захватом и удержанием различных объектов, формирование конечной выборки изображений взаимного расположения робота и объекта и подбор соответствующих им значений углов поворота корпуса, манипуляторов и кистей робота, а также степеней сгибания пальцев и степеней искривления ладоней. Затем компьютеру ставят задачу, например «захват» объекта, с первой нейронной сети на микроконтроллер поступает сигнал со значениями углов поворота корпуса и манипуляторов робота для достижения касания объекта, вторая нейронная сеть корректирует эти углы, третья нейронная сеть выдает на микроконтроллер значения угла поворота кисти, степени сгибания пальцев и искривления плоскости ладони. 2 н. и 2 з.п. ф-лы, 10 ил.

 

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

Известна обучающе-игровая система с компьютерным управлением, предназначенная для управления подвижным устройством, например игрушкой (машинкой) [Патент РФ №2241255, МПК G06F 17/60]. Система содержит персональный компьютер с набором программ, соединенный с базовым модулем приемопередатчика с антенной, дистанционный пульт для управления системой с использованием цифрового и/или аналогового радиоканалов и/или инфракрасного канала, модуль обеспечения обмена информацией, соединенный с центральным модулем управления, установленные на подвижном объекте. Центральный модуль управления выполнен с функцией ретрансляции поступающих с персонального компьютера команд и с функцией ретрансляции на персональный компьютер данных с датчиков окружающей среды. Модуль обеспечения обмена информацией предназначен для трансляции информации на центральный модуль управления.

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

Известна система управления (СУ) антропоморфным роботом, состоящим из корпуса с манипуляторами и кистевыми схватами и приводов, принятая за прототип [Авторское свидетельство СССР №1646850, МПК B25J 9/10]. Выходы системы управления соединены с приводами манипулятора и кистевыми схватами.

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

Известен способ управления антропоморфным роботом, принятый за прототип [Авторское свидетельство СССР №1646850, МПК B25J 9/10]. Способ осуществляется с помощью системы управления, формирующей команды управления, которые подаются на приводы манипуляторов и кистей робота.

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

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

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

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

Также поставленная задача решена за счет того, что в известном способе управления антропоморфным роботом, состоящим из корпуса с манипуляторами и кистями и приводов, согласно изобретению, используют заявляемую систему управления антропоморфным роботом, определяют положение робота, осуществляют подачу управляющих сигналов на микроконтроллер и включают приводы робота после получения сигналов с микроконтроллера, осуществляют предварительное обучение нейронных сетей на выполнение задач, связанных с захватом и удержанием роботом объектов различной формы и веса, и формируют конечную выборку изображений взаимного расположения робота и объекта и соответствующих им значений углов поворота корпуса, манипуляторов и кистей робота, а также степеней сгибания пальцев и степеней искривления ладоней, причем в качестве входных обучающих сигналов для первой нейронной сети используют полученные от системы технического зрения изображения расположения объекта, находящегося в зоне захвата, относительно корпуса и манипуляторов робота, а в качестве выходных сигналов используют угол α поворота корпуса относительно горизонтальной оси симметрии робота, угол β наклона корпуса по отношению к вертикальной оси, угол γ между плечевой частью манипулятора и корпусом и угол δ между плечевой и локтевой частями манипуляторов, в качестве входных обучающих сигналов для второй нейронной сети используют полученные от системы технического зрения изображения расположения объекта относительно светового маячка, а в качестве выходных сигналов используют корректирующие добавки α1, β1, γ1, δ1 к углам α, β, γ, δ, в качестве входных обучающих сигналов для третьей нейронной сети используют полученные от системы технического зрения изображения формы объекта, а в качестве выходных сигналов используют угол ε поворота плоскости кистей, степени сгибания пальцев и степени искривления плоскости ладоней кистей, затем после постановки задачи последовательно первой нейронной сетью выдают микроконтроллеру значения углов α, β, γ, δ, необходимых для достижения касания объекта кистями робота, второй нейронной сетью выдают микроконтроллеру корректирующие добавки α1, β1, γ1, δ1 к значениям углов α, β, γ, δ, пока на микроконтроллер не поступит сигнал хотя бы с одного тактильного датчика, при поступлении на микроконтроллер сигналов более чем 70% тактильных датчиков третьей нейронной сетью выдают микроконтроллеру значения угла ε, степени сгибания пальцев и степени искривления плоскости ладоней кистей

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

Изобретение иллюстрируется чертежами, где на фиг.1 показано исходное положение робота (вид сбоку); на фиг.2 - положение робота при наклоне корпуса (вид сбоку); на фиг.3 - положение плечевой части манипулятора относительно корпуса робота; на фиг.4 - взаимное расположение плечевой и локтевой частей манипулятора; на фиг.5 - исходное положение робота (вид сверху); на фиг.6 - положение корпуса робота при его повороте; на фиг.7 - вид А-А (кисть в исходном состоянии); на фиг.8 - схема тактильного датчика; на фиг.9 - вид на внутреннюю сторону кисти; на фиг.10 - общая схема системы управления.

Система управления (СУ) антропоморфным роботом, состоящим из шасси 1, головы 2 и корпуса 3 с манипуляторами 4 и кистями 5, содержит систему технического зрения (СТЗ) 6, компьютер 7, размещенный внутри корпуса 3 робота, микроконтроллер 8, соединенный с компьютером 7, приводы 9 робота, соединенные с микроконтроллером 8 (фиг.1, 10).

СТЗ 6 содержит две телекамеры 10, установленные на голове 2 робота, и блок обработки сигналов 11. На конце указательного пальца кисти 5 установлен световой маячок 12, например красный светодиод, который однозначно распознается СТЗ 6 (фиг.5). Выходы СТЗ 6 связаны с тремя обученными нейронными сетями (НС) 13,14,15, установленными на компьютере 7.

На внутренних поверхностях и кончиках пальцев кистей 5 робота размещены тактильные датчики 16 (фиг.9). Каждый датчик 16 состоит из разделенных калибровочной пружиной 17 наружного 18 и внутреннего 19 чувствительных элементов (фиг.8). Жесткость пружины 17 подбирают с учетом оптимальной степени сжатия для набора объектов различной формы и веса, которыми манипулирует робот.

Ввод команд роботу осуществляют с дистанционного пульта управления 20 либо через расположенный на теле робота микрофон 21, выход которого соединен с компьютером 7. На фиг.2-6 рядом с роботом показан объект 22, например мячик.

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

Предварительно оператором (человеком) на основе собственного опыта и наблюдаемого результата действий манипуляторов робота производится обучение нейронных сетей (НС) 13, 14, 15 на «касание» и «охват» различных объектов. Все НС 13, 14, 15 обучаются одинаковым образом на основе конечной выборки входных сигналов в виде изображений взаимного расположения робота и объекта, полученных от СТЗ 6, каждому из которых соответственно подбираются необходимые значения углов поворота корпуса 3 и манипуляторов 4 робота, а также степени сгибания пальцев и степени искривления ладони кистей 5, зависящих от формы и веса объекта.

Первую нейронную сеть 13 обучают на выполнение задачи «касание» кисти 5 робота объекта 22, причем под «касанием» понимают момент, когда сработает чувствительный элемент 18 хотя бы одного тактильного датчика 16. Для НС 13 входными обучающими сигналами будут полученные от СТЗ изображения расположения объекта 22 относительно шасси 1, корпуса 3 и манипуляторов 4 робота в момент, когда робот приблизился к объекту 22 настолько, что объект оказался в зоне захвата. Выходными (возвращаемыми) параметрами будут угол α - поворот корпуса 3 от горизонтальной оси симметрии робота, угол β - наклон корпуса 3 по отношению к вертикали, угол γ - между плечевой частью манипулятора 4 и корпусом 3, угол δ - между плечевой и локтевой частями манипулятора 4.

Вторая нейронная сеть 14 предназначена для корректировки взаиморасположения манипулятора 4 и объекта 22 с целью более точного позиционирования кисти 5 на случай, если по результатам применения НС 13 «касание» объекта не было достигнуто. Для НС 14 входными обучающими сигналами будут полученные от СТЗ 6 изображения расположения объекта 22 относительно маячка 12. Выходными (возвращаемыми) параметрами будут корректирующие добавки α1, β1, γ1, δ1 к углам α, β, γ, δ.

Третью нейронную сеть 15 обучают на выполнение задачи «охват » кистью 5 робота объекта 22, причем под «охватом» понимают момент, когда срабатывают чувствительные элементы 18 более чем 70% тактильных датчиков 16. Для НС 15 входными обучающими сигналами будут полученные от СТЗ изображения формы объекта. Выходными (возвращаемыми) параметрами будут угол ε - поворот плоскости кисти 5, степени сгибания пальцев и искривления плоскости ладони кисти 5.

После завершения обучения нейронных сетей 13, 14, 15 человек отстраняется от непрерывного управления и только ставит задачи. Например, голосом либо с пульта управления 20 человек ставит задачу «взять объект», например, мячик. Эта задача выполняется максимум в 7 этапов.

На 1-м этапе осуществляется подъезд робота к объекту 22, для чего с компьютера 7 через микроконтроллер 8 подается сигнал на включение приводов 9 шасси 1 робота. Когда робот подъезжает к объекту 22 на расстояние, достаточное для его захвата (зависит от размеров корпуса робота и длины его манипуляторов), на микроконтроллер 8 подается команда остановки. Это расстояние определяется экспериментально и заносится в память компьютера 7.

Во время движения корпус 3 робота и его манипуляторы 4 находятся в исходном положении, т.е. угол α равен 0°, угол β равен 0°, угол γ равен 0°, угол δ равен 90°, угол ε равен 90°. Таким образом, корпус 3 находится в вертикальном положении и ориентирован по ходу движения робота, манипуляторы 4 опущены вниз и согнуты в локтях, плоскости кистей 5 расположены горизонтально (тыльной стороной вверх).

2-й этап. После остановки робота СТЗ 6 передает информацию о взаимном расположении корпуса 3, манипуляторов 4 робота и объекта 22 на вход нейронной сети НС 13. Нейронная сеть 13 выдает микроконтроллеру 8 значения углов α, β, γ, δ, необходимых для достижения «касания» кисти 5 объекта 22, т.е поступления сигнала хотя бы с одного чувствительного элемента 18. Угол ε при этом не изменяется. Микроконтроллер 8 последовательно включает приводы 9 корпуса 3 и манипуляторов 4 на время, необходимое для достижения нужных углов.

3-й этап. В случае, если касание не произошло, для более точного позиционирования кисти 5 относительно объекта 22 выполняется дополнительный цикл управления с использованием корректирующей нейронной сети НС 14. Получив от СТЗ 6 информацию о текущем взаимном расположении объекта 22 и светового маячка 12, НС 14 выдает микроконтроллеру 8 значения необходимых корректирующих добавок α1, β1, γ1, δ1 к углам α, β, γ, δ, и микроконтроллер 8 включает приводы 9 манипулятора 4.

4-й этап - «нащупывание» объекта. В случае, если по окончании 3-го этапа не произошло касания объекта, СУ проводит его поиск, меняя углы (α+α1), (β+β1), (γ+γ1), (δ+δ1) на небольшие значения (α2, β2, γ2, δ2 по алгоритму «случайного поиска» до достижения касания.

5-й этап - «охват» объекта 22, в ходе которого должно быть достигнуто «срабатывание» более чем 70% чувствительных элементов 18 тактильных датчиков 16. НС 15, получив от СТЗ 6 информацию о форме объекта 22, выдает микроконтроллеру 8 корректирующую добавку ε1 к углу ε, степени сгибания пальцев и искривления плоскости ладони, после чего микроконтроллер 8 включает приводы 9 кисти 5, поворачивающие ладонь, сгибающие пальцы и искривляющие плоскость ладони.

6-й этап - «ощупывание» объекта. В случае, если по окончании 5-го этапа произошло срабатывание менее 70% чувствительных элементов 18 тактильных датчиков 16. СУ изменяет угол (ε+ε1) на небольшие значения ε2, степень сгибания пальцев и степень искривления ладони по алгоритму «случайного поиска» до достижения охвата объекта 22.

7-й этап - «захват» объекта 22. После того, как более 70% чувствительных элементов 18 даст сигнал о «касании» объекта 22, компьютер 7 через микроконтроллер 8 дает команду приводам 9 кисти 5 на дальнейшее сгибание пальцев и искривление плоскости ладони. Сгибание пальцев и искривление плоскости ладони осуществляется до тех пор, пока не поступит сигнал от чувствительных элементов 19 тех датчиков 16, элементы 18 которых коснулись объекта 22. Чувствительные элементы 19 срабатывают в момент достижения пружины 17 заданной степени сжатия, что приводит к соприкосновению между собой чувствительных элементов 18 и 19. После этого объект 22 считается захваченным, и микроконтроллер 8 дает команду приводам 9 кисти 5 прекратить дальнейшее сгибание пальцев и искривление плоскости ладони.

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

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

3. Способ управления антропоморфным роботом, содержащим корпус с манипуляторами и кистями и приводы, отличающийся тем, что используют систему управления по п.1, определяют положение робота, осуществляют подачу управляющих сигналов на микроконтроллер и включают приводы робота после получения сигналов с микроконтроллера, осуществляют предварительное обучение нейронных сетей на выполнение задач, связанных с захватом и удержанием роботом объектов различной формы и веса и формируют конечную выборку изображений взаимного расположения робота и объекта и соответствующих им значений углов поворота корпуса, манипуляторов и кистей робота, а также степеней сгибания пальцев и степеней искривления ладоней, причем в качестве входных обучающих сигналов для первой нейронной сети используют полученные от системы технического зрения изображения расположения объекта, находящегося в зоне захвата, относительно корпуса и манипуляторов робота, а в качестве выходных сигналов используют угол α поворота корпуса относительно горизонтальной оси симметрии робота, угол β наклона корпуса по отношению к вертикальной оси, угол γ между плечевой частью манипулятора и корпусом и угол δ между плечевой и локтевой частями манипуляторов, в качестве входных обучающих сигналов для второй нейронной сети используют полученные от системы технического зрения изображения расположения объекта относительно светового маячка, а в качестве выходных сигналов используют корректирующие добавки α1, β1, γ1, δ1 к углам α, β, γ, δ, в качестве входных обучающих сигналов для третьей нейронной сети используют полученные от системы технического зрения изображения формы объекта, а в качестве выходных сигналов используют угол ε поворота плоскости кистей, степени сгибания пальцев и степени искривления плоскости ладоней кистей, затем после постановки задачи последовательно первой нейронной сетью выдают микроконтроллеру значения углов α, β, γ, δ, необходимых для достижения касания объекта кистями робота, второй нейронной сетью выдают микроконтроллеру корректирующие добавки α1, β1, γ1, β1 к значениям углов α, β, γ, δ, пока на микроконтроллер не поступит сигнал хотя бы с одного тактильного датчика, при поступлении на микроконтроллер сигналов более чем 70% тактильных датчиков третьей нейронной сетью выдают микроконтроллеру значения угла ε, степени сгибания пальцев и степени искривления плоскости ладоней кистей.

4. Способ по п.3, отличающийся тем, что корректировку углов (α+α1), (β+β1), (γ+γ1), (δ+δ1), (ε+ε1) на малые значения α2, β2, γ2, δ2, ε2 осуществляют в соответствии с алгоритмом «случайного поиска».



 

Похожие патенты:

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

Изобретение относится к области сварки, в частности к системе управления, предназначенной для управления рабочей машиной для изменения пространственного положения обрабатываемой детали в процессе сварки сварочным роботом.

Изобретение относится к робототехнике. .

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

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

Изобретение относится к робототехнике. .

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

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

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

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

Изобретение относится к области робототехники

Изобретение относится к области робототехники и может быть использовано для автономного управления машинами специального назначения в условиях естественной среды

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

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

Изобретение относится к способу и устройству для выбора и захвата объекта из неструктурированной области робота, а также к машиночитаемому носителю, на котором хранится компьютерная программа, содержащая код для управления процессором для выполнения способа. Устройство принимает первые данные от первого датчика и определяет целевое положение, включающее положение в пространстве или ориентацию захватного устройства в роботизированной руке. Для перемещения захватного устройства в целевое положение подают первые команды роботизированной руке или захватному устройству. Данные силовой обратной связи принимают от первых датчиков или от датчиков силовой обратной связи, связанных или с роботизированной рукой или с захватным устройством. Определяют неудачу при выполнении первых команд. Принимают вторые данные датчика от первого датчика. По вторым данным датчика определяют успешный захват объекта. В ответ на определение успешного захвата принимают данные верификации от второго датчика и подают вторые команды роботизированной руке для перемещения руки в заранее заданное положение с отпусканием захвата захватного устройства. Изобретение обеспечивает повышение качества выбора объектов в рабочем пространстве робота. 3 н. и 11 з.п. ф-лы, 3 ил.

Группа изобретений относится к области животноводства. Технический результат - повышение безопасности процесса доения. Система доения содержит доильный робот (10). Робот содержит первое звено (L1), второе звено (L2), третье звено (L3), рабочий орган (Е), датчик (16) и блок управления (15). Первое звено может поворачиваться до первого угла в пределах первого углового сектора (α1) через первое соединение (11). Второе звено может поворачиваться до второго угла в пределах второго углового сектора (α2) через второе соединение (12). Третье звено может поворачиваться до третьего угла в пределах третьего углового сектора (α3) через третье соединение (13). Звенья (L1, L2, L3) могут поворачиваться так, что рабочий орган (Е) может двигаться внутри трехмерного рабочего пространства (W) доильного робота (10). Каждое положение рабочего органа (Е) в пределах рабочего пространства (W) соответствует отдельному сочетанию первого, второго и третьего углов. 2 н. и 14 з.п. ф-лы, 10 ил.

Группа изобретений относится к садоводству, а именно к системам управления для обслуживания земельного участка. Система включает в себя сенсорное оборудование, оборудование для выполнения задач, устройство управления обслуживанием двора и робота. Сенсорное оборудование включает в себя один или более датчиков, расположенных на участке земли. Оборудование для выполнения задач выполнено с возможностью выполнения задачи на этом участке. Задача связана с генерацией результата, который контролируется посредством сенсорного оборудования. Устройство управления обслуживанием двора выполнено с возможностью взаимодействия с сенсорным оборудованием и оборудованием для выполнения задач для сравнения измеренных условий с необходимыми условиями, для управления функционированием оборудования для выполнения задач. Робот выполнен с возможностью обработки участка и выполнения по меньшей мере одного из действия в качестве одного из одного или более датчиков, действия в качестве устройства оборудования для выполнения задач, или взаимодействия с сенсорным оборудованием или оборудованием для выполнения задач. Использование группы изобретений позволит автоматизировать управление обслуживания земельного участка. 3 н. и 22 з.п. ф-лы, 7 ил.
Наверх