Способ управления движением двухзвенного манипулятора и устройство для его осуществления

Способ управления движением двухзвенного манипулятора и устройство для его осуществления

Иллюстрации

Показать все

Реферат

 

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

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

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

РЕСПУБЛИК (и)5 В 25 J 9/16

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

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

ПРИ ГКНТ СССР

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

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4705053/08 (22) 14.06.89 (46) 30.01.92. Бюл. ЬЬ 4 (71) Алтайский политехнический институт им. И.И,Полэунова (72) П,И.Госьков, Л,Н.Федин и В.К.Одинцов (53) 62-229.72(088.8) (56) Динамика управления роботами, M., Главная редакция физико-математической литературы, 1984, с. 307. (54) СПОСОБ УПРАВЛЕНИЯ ДВИЖЕНИЕМ

ДВУХЗВЕННОГО МАНИПУЛЯТОРА И УСТРОЙСТВО ДЛЯ ЕГО ОСУЩЕСТВЛЕНИЯ (57) Изобретение относится к робототехнике и может быть использовано для программного управления движением манипуляторов антропоморфного типа.

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

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

На фиг.1 представлена блок-схема устройства управления; на фиг,2 — кинематическая схема манипулятора.

При отработке заданных параметров движения контурами управления звеньями

» Я2 1708602 А1 ния ошибки линейной скорости перемещения схвата путем учета изменения конфигурации манипулятора. При обработке заданных параметров движения контурами управления звеньев манипулятора скорости вращения звеньев задают, исходя иэ условия щ /в1 = — (cos Oz/(1 +y) я, ), где е1 ив - значения скорости вращения первого и второго звеньев соответственно; — угол поворота второго звена относительно первого; — коэффициент относительной погрешности скоростей вращения звеньев; ое — коэффициент относительной длины звеньев. Для этого в устройство управления манипулятором, содержащее контуры управления первым и вторым звеньями, дополнительно вводят блок 12 преобразования сигналов, который соответствующим образом связывает указанные контуры управления. 2 с.п.ф-лы, 2 ил. манипулятора скорости вращения звеньев задают, исходя из условия в соз гФ (1 + "г ) ее где со и сщ — значения скоростей вращения первого и второго звеньев; — угол поворота второго звена относительно первого; у — коэффициент относительной погрешности скоростей вращения звеньев(исполнительных приводов); ае — коэффициент относительной длины звеньев.

При этом у —, где Ьв и Ла —

Ьса

ACd1 погрешности скоростей вращения приводов первого и второго звеньев;

1708602 2 е, =- --, где I> и Ь вЂ” длины первого и второго

11 звеньев.

Устройство, реализующее данный способ управления, содержит регулятор 1 и 2 положения первого и второго звеньев, первый, второй и третий сумматоры 3,4 и 5, первый и второй функциональные преобразователи 6 и 7, первый и второй умножители

8 и 9, регуляторы 10 и 11 скорости первого и второго звеньев, причем входы регуляторов 1 и 2 положения подключены к входным шинам сигналов задания положения соответственно первого и второго звеньев. Кроме того, входная шина сигнала задания положения второго звена подключена к входу первого функционального преобразователя 6, выходы регуляторов 1 и 2 положения подключены соответственно к первому входу сумматора 3 и первому входу сумматора

4, выход функционального преобразователя

6 подключен к первому входу умножителя 8 и вход функционального преобразователя

7. Второй вход умножителя 8 подключен к выходу регулятора 1 положения,а выход умножителя 8 подключен к входу тоетьего сумматора 5, второй (вычитающий) вход которого подключен к выходу регулятора 2 положения второго звена. Выходсумматора

5 подключен к первому входу умножителя 9, второй вход которого подключен к выходу функционального преобразователя 7. Выход умножителя 9 подключен к вычитающему входу первого сумматора 3 и второму входу второго сумматора 4. Выход сумматора 3 подключен к входу регуляторов 10 скорости первого звена, а выход второго сумматора 4 подключен к входу регулятора

11 скорости второго звена. Выходы регулятора 10 и 11 скорости подключены к выходным шинам управления исполнительными приводами первого и второго звеньев, соответственно (не показаны). Сумматор 5, умножители 8 и 9, преобразователи 6 и 7 составляют блок 12 преобразования сигналов.

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

Сигналы заданного положения первого и второго звеньев 01 и 6 отрабатываются соответствующими регуляторами 1 и 2 положения, которые задают скорости движения первого звена в и второго звена сФ в виде сигналов, поступающих соответственно на первый вход первого сумматора 3 и первый вход второго сумматора 4. Одновременно сигнал заданного положения второго звена (угол 6 ) поступает на вход первого функционального преобразователя 6, в ков1 =в> — (в1 с -в2)

1 Ж 4

1+с и определяющему скорость (частоту вращения) первого звена. На выходе второго сумматора 4 будет сформирован сигнал, значение которого равно выражению

50 ар =oh + —. (в с -а ) 1 е:в

1+с и определяющему скорость (частоту вращения) второго звена. Поскольку сигналы с вытором этот сигнал преобразуется по косинусоидальной фуйкции (cos 5) и затем поступает на первый вход первого умножителя 8 и на вход второго функционального преоб5 разователя 7. На второй вход умножителя 8 поступает сигнал с входа регулятора 1 положения первого звена (в1), задающий скорости первого звена. В умножителе 8 происходит перемножение входных сигналов с коэффициентом, равным

1 (1+у) к, т.е, на выходе первого умножителя будет е соэ сигнал, равный N>,1 êîòîðûé пода15 (1 +)

25 вход второго умножителя 9. В это же время с выхода первого функционального преобразователя 6 сигнал, пропорциональный функции cos ®, поступает на вход второго функционального преобразователя 7, в ко30 тором он преобразуется согласно следую1 щему соотношению: — и с

1+ соэт (Т ФЯ Ее выхода функционального преобразователя

7 подается на второй вход умножителя

9. где перемножается с сигналом ошибки Л. Таким образом, на выходе второго умножителя 9 будет присутствовать сигнал, равный

40 cos % (в1 с — в ) где с — „., ко1+с 1+y) ее торый поступает на вычитающий вход первого сумматора 3 и нг второй вход второго сумматора 4. На выходе первого сумматора

45 3 будет сформирован сигнал, значение которого равно следующему выражению:

1708602 ходов сумматоров 3 и 4 поступают соответственно на входы регуляторов 10 и 11 скорости первого и второго звеньев, то после их отработки в регуляторах 10 и 11 скорости происходит управление исполнительными приводами первого и второго звеньев согласно данному способу управления, что позволяет при постоянно изменяющейся конфигурации манипулятора,минимизировать ошибку линейной скорости Ж/ движения захвата (т. 0 на фиг.2).

Регуляторы 1 и 2 положения первого и второго звеньев и регуляторы 10 и 11 скорости первого и второго звеньев могут представлять собой звенья с передаточными функциями, обеспечивающими соответствующий закон регулирования (пропорциональный, пропорционально-интегральный, пропорционально-интегрально-дифференциальный).

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

1. Способ управления движением двухзвенного манипулятора, заключающийся в программном задании параметров движения звеньев и отработка заданных параметров контурами управления каждого звена, отличающийся тем, что, с целью повышения точности движения, соотношеwe скоростей вращения звеньев определяется из условия са cos 6 о® {1+y) я, где е> и а — скорости вращения первого и второго звеньев соответственно;

5 д — угол поворота второго звена относительно первого;

y — коэффициент относительной погрешности скоростей вращ ния звеньев; о — коэффициент относительной длины звеньев.

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

З5 сигналов.

1708602

Составитель И.Афонин

Редактор Т,Лошкарева Техред М.Моргентал Корректор Л.Патей

°вЂ”

Заказ 391 Тираж Подписное

ВНИИПИ Государственного комитета по изобретениям и открытиям при ГКНТ СССР

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

- Производственно-издательский комбинат "Патент", г. Ужгород. ул.Гагарина, 101