CC BY
27
Определение максимальных значений параметров задающих угол сервиса и множество конфигураций андроидного робота реализацией
мгновенных состояний
Ф.Н. Притыкин, В. И. Небритов Омский государственный технический университет, г. Омск
Аннотация: В работе определены максимальные значения параметров задающих проекции угла сервиса андроидного робота реализацией мгновенных состояний исполнительного механизма руки и туловища, при которых обеспечена заданная точность позиционирования центра выходного звена.
Ключевые слова: мгновенные состояния механизмов манипуляторов, виртуальное моделирование движений, угол сервиса, андроидные роботы.
В настоящее время ведутся активно работы связанные с созданием интеллектуальных систем управления роботами для широкого диапазона возможных ситуации[1]. В данных системах вместо непосредственной записи траектории движения робота применяется модель окружающей среды и механизма манипулятора. Система автономно генерирует движение робота, основываясь на данные модели, в соответствии с описанием задания. При этом возможности манипулятора связанные с выполнением заданий надежно могут быть заранее и накануне реализации движения смоделированы виртуально. После того как робот определен (зафиксирован) в реальной рабочей обстановке, гибридная система управления начинает генерировать синтез движений от начальной до целевой точки на основе указанных моделей. Затем требуемое задание определяется как последовательность операций. При этом на последнем этапе используется силомоментный алгоритм управления с использованием системы очувствления. Каждая операция при этом является немедленно выполнимой с помощью модели окружающей среды. Таким образом, задание выполняется за короткий интервал времени без использования не обоснованных и лишних движений.
При виртуальном моделировании движений механизмов роботов с использованием метода построения движений по вектору скоростей, необходимо вычислять на каждом шаге расчётов значение вектора Q приращений обобщённых координат [2]. С целью преодоления тупиковых ситуаций, необходимо обеспечивать максимальные значения параметров, характеризующих манипулятивность указанного робота. Поэтому исследования связанные с определением угла сервиса механизмовроботови параметров, характеризующих манипулятивностьв различных точках конфигурационного пространства, остаются актуальной задачей.
Значение вектора Q находится точкой № принадлежащей р-плоскости Г, которая задана линейной системой уравнений определяющей взаимосвязь скоростей ВЗ и обобщённых скоростей [3-6]. Верхний индекс Определяет принадлежность точек многомерному пространству обобщенных скоростей Q. Размерность указанной р-плоскости Г, в пространстве Q определяет степень двигательной избыточности. Положение точки е Гзадаётся координатами к], к2 и т. д.:
вж - С«-Н^ДОк, (1)
где Qм— вектор, задающий точку М е Г соответствующую критерию минимизации объёма движения [2]. Точка М центр репера связанного с р-плоскостью; к — координаты точки N в р-плоскости Г; т — длина единичного отрезка репера плоскости Г. Ql — единичные направляющие векторы осей репера.
Определим максимальное значение параметров к при которых происходит изменение угла П3, характеризующего угол сервиса[3] на примере механизма андроидного робота. В работе [7] исследовалась форма областей в пространстве обобщённых скоростей, которая задавала множество конфигураций, удовлетворяющих заданной точности позиционирования центра выходного звенаразличных механизмов. Однако максимальные
значения параметров кгтах в указанной работе для конфигураций андроидного робота не определялись. Определим всвязи с этим значения указанных параметров для механизма руки и туловища указанного робота при точности позиционирования 8 = 5мм. (см. рис. 1). Данная точность позиционирования достаточна для обеспечения захвата различных объектов манипулирования.
Определим так же проекции угла П3 образованного продольной осью звена руки андроидного робота с использованием метода основанного на реализации мгновенных состояний. Угол П3 характеризует манипулятивность выходного звена при размещении его центра в заданной точке зоны обслуживания [3,8,9]. Разные конфигурации манипулятора обеспечивают различный угол сервиса. На данный параметр влияют количество звеньев манипулятора и его положение определяемое значениями обобщённых координат. На рисунке 1а представлены системы координат Qkxkykzk связанные со звеньями механизма руки и туловища андроидного робота ЛЯ-600Е (12 > к > 1), положение которых определяют обобщённые координаты qi(5 > I > 1). Где к определяет номер системы координат связанной со звеньями механизма.Соответственно на рисунке 1б изображен общий вид андроидного робота. В соответствии с методикой обозначения геометрических моделей открытых кинематических цепей принятой в работах [7,10] данный механизм имеет следующее обозначение М3-12-10-8-3-12-2-12-3-12-2-12. Значения списков массивов[10], характеризующие геометрическую модель исполнительного механизма руки заданы в таблице.Значения длин^ задают размеры звеньев механизмов, которые определяют отрезки ¡¡= О1О2, ¡2= О2О3, ¡3= О3О6, ¡4= О6О8, 15= О8О10 и 16= О10О12(см. рис. 1а).В таблице параметр пкос1 определяет значение кода преобразований систем координат [7].
Таблица
Значения массивов и кодов, определяющих геометрическую модель механизма андроидного робота
Массивы Номер преобразования систем координат
1 2 3 4 5 6 7 8 9 10 11 12
о 10 о о о о 0 <4 о о 5 чо о о 5 о о 5 чо о
'—» 0 0 0 0 0 0 0 0 0 0 0 0
1 о '—» '—1 н <N1 о 0 ОО 8 О '—1 о ОО о •о '—* о •о II 43
ПкосС 3 12 11 7 3 12 2 12 3 12 2 12
Определим проекции угла П8и максимальные значения параметра кгтах при направлении вектора скорости ВЗ Квдоль оси О0 х0. Заметим, что направление вектора скорости ^существенного влияния на параметры П8и
тах
к не оказывает. Это подтверждают результаты многочисленных вычислительных экспериментов.Учитывая то, что размерность вектора Кравна трем, а число обобщенных координат ровно пяти, двигательная избыточность для рассматриваемого случая равна двум. В процессе исследований были определены максимальные значения параметров кгтах, которые обеспечивают максимальный угол сервиса для различных конфигураций. Определение параметра кгтах выполнялось по алгоритму, представленному на рисунке 2.
1 Za=Zt=Z2
а б
Рис. 1. Механизм андроидного робота; а - системы координат связанные со звеньями механизма; б - общий вид андроидного робота
На нём приняты следующие обозначения: 1 - задание первоначального
7 max т т max г\ l max к п l max j max
значения параметров ki , Us = 0, kiV = 0. Значения kiV и kiM опреде-
max
ляют интервал поиска значения ki , который с каждой итерацией сужается;
2 т т 1 max т т max т т ->
- определение угла Us соответствующего параметру ki ,Us = Us; 3 -
J
7 max j max j max /7 max /<-\\ тт j max 7 max л
kiV = ki , kiM = (ki /2), определение угла (Лпри ki = kiM ; 4 -
max max max max max
US<US ; 5 - ki = kiM ; 6 - ki = k,r ■
7 max о M ^ M mm
kiM ; 8 - Ak<Aki
max max max
(kiV — kiM )/2; 7 - Ak = k,-v -iM ; 8 - Ak<Aki , где Ak™" изначально заданный параметр, характеризующий минимальное удаление точки N,q от точки Ni+1Q соответственно на i и i+1 итерациях; 9 - конец.
Рис. 2. Алгоритм определения k/
Исследования проводились на моделях, построенных в среде AutoCAD с использованием языка AutoLISP. Конфигурации исследовались для случаев, когда обобщённые координаты принимают значения qi (25о, 20о, q3, 25о, q5) при этом 0o < q3 <65o,0o < q5 <65o. На рисунке 3 изображены проекции угла U-на фронтальной, горизонтальной и профильной плоскостях проекций.На этом рисунке обозначения О12(1), О12(2;О12(3;соответственно определяют положения центра выходного звена (руки) на различных плоскостях проекций. На рисунке 4 представлены зависимости Usi = f1(q3,5) проекций углов от обобщенных координат qзи q5при равенстве обобщенных координат q3,5=q3 =q5. Как видно из рисунка, между значениями q3,5 и параметрами Usi существует нелинейная зависимость.
На рисунке 5 представлены зависимости Us = f2(q3 , q5) , klmax = f3(q3,q5).Угол Us определяют по формуле (среднее значение проекций угла сервиса):
J
Us=^+Us+Um)/3,
где U^,UszuUsn соответственно проекции угла Us на фронтальной, горизонтальной и профильной проекциях.
Рис. 3. Проекции угла Us(Us1, Us2, Us3) для конфигурации q (25о, 20о, 65о, 25о, 65о)
Рис. 4. Графики зависимостей Usi = f1(q3,s)
70
а
б
Рис. 5. Графики зависимостей: а -kmax = f2(qзДs),б = fз(qзД5)
Результаты проведённых исследований показывают, что при автоматизированном синтезе движений механизма андроидного робота для различных конфигураций значения параметров Usiи ^^различные. Показатели манипулятивности возрастают при увеличении значений обобщенных координат q3иq5.Проведенные исследования могут быть использованы при разработке интеллектуальных систем управления, которые позволяют на виртуальном уровне планировать траектории перемещения руки андроидного робота в сложно организованном пространстве, с целью обеспечения его автономного функционирования.
1. Ющенко, А. С.Интеллектуальное планирование в деятельности роботов // Мехатроника, автоматизация, управление. 2005. №3. - С. 5 - 18.
2. Кобринский, А. А., Кобринский А.Е. Манипуляционные системы роботов.— М.: Наука — 1985. — 343 с.
3. Притыкин, Ф. Н. Обобщенный метод определения угла сервиса для плоских незамкнутых механизмов манипуляторов на основе анализа мгновенных состояний // Мехатроника, автоматизация, управление. 2014. —
Библиографический список:
№4 — С. 41—45.
4. Притыкин, Ф. Н., Нефедов Д.И., Захаров В.А., Рингельман А.В. Обобщенный метод исследования мобильности плоских механизмов манипуляторов // Инженерный вестник Дона, 2015, № 3. URL: indon.ru/ magazine//archive/n3y2015/3095.
5. Denavit, J., Hartenberg R. S. Cinematic notation for Lower-Pair Mechanisms Based on Matrices // J. Appl. Mech. - 1955. - Vol. 77. -Р. 215-221.
6. Wihtney, D. E. The mathematics of coordinated control of prosthetic Arms and Manipulators // Tpons. ASME, Ser G, J Dymamic, Just, Meas and Control. -1972. - Vol. 94, № 4. - Р.19-27.
7. Притыкин, Ф. Н. Виртуальное моделирование движений роботов, имеющих различную структуру кинематических цепей: монография. — Омск: Изд-во ОмГТУ, 2014. — 172 с.
8. Лебедев, П.А. Аналитический метод определения коэффициента сервиса манипулятора // Проблемы машиностроения и надежности машин. -1991. - №5. - С. 93 - 98.
9. Корендясёв, А. И., Саламандра Б.Л. Манипуляционные системы роботов / М.: Машиностроение, 1989. — 472 с.
10. Притыкин, Ф. Н., Осадчий А.Ю.Способ кодирования информации при задании геометрических моделей исполнительных механизмов роботов // Инженерный вестник Дона, 2014, № 2. URL: indon.ru/ magazine//archive/n2y2014/2363/.
References
1. Yushchenko, A. S.Mekhatronika, avtomatizatsiya, upravlenie. 2005. №3. pp. 5 - 18.
2. Kobrinskiy A. A., Kobrinskiy A. E. Manipulyatsionnye sistemy robotov [Manipulation of robots]. M.: Nauka. 1985. 343 p.
3. Pritykin, F. N., Gordeev O.I. Mekhatronika, avtomatizatsiya, upravlenie. 2014. № 4. pp. 41-45.
4. Pritykin, F. N. Inzenernyj vestnik Dona (Rus), 2015, № 3. URL: indon.ru/ magazine//archive//n3y2015/3095/.
5. Denavit, J. J. Appl. Mech. 1955. Vol. 77. pp. 215-221.
6. Wihtney, D. E. Tpons. ASME, Ser G, J Dymamic, Just, Meas and Control. 1972. Vol. 94, № 4. pp.19-27.
7. Pritykin, F. N. Virtual'noe modelirovanie dvizheniy robotov, imeyushchikh razlichnuyu strukturu kinematicheskikh tsepey:monografiya [Virtual modeling movements of robots with different structures kinematic chains].Omsk: Izd-voOmGTU, 2014. 172 p. :il.
8. Lebedev, P. A. Problemy mashinostroeniya i nadezhnosti mashin, 1991. №5. рр. 93 - 98.
9. Korendyasev A. I., Salamandra B. L., Tyves L. I. Manipulyatsionnye sistemy robotov [Manipulation of robots]. M.:Mashinostroenie, 1989. 472 p.
10. Pritykin, F. N. Inzenernyj vestnik Dona (Rus),2014, № 2. URL: indon.ru/ magazine//archive/n2y2014/2363/.
