CC BY
24
УДК 621.01
Ф.Н. Притыкин, О.И. Гордеев
ИССЛЕДОВАНИЕ ТОЧНОСТИ ОПРЕДЕЛЕНИЯ УГЛА СЕРВИСА НА ОСНОВЕ СИНТЕЗА ДВИЖЕНИЙ МАНИПУЛЯТОРА ПО ВЕКТОРУ СКОРОСТЕЙ
Оценка функциональных возможностей робототехнических устройств при наличии кинематической избыточности в различных точках зоны обслуживания остается актуальной задачей. Возможность изменения ориентации схвата при размещении его центра в заданной точке зоны обслуживания характеризуется углом сервиса (для плоских механизмов этот угол является плоским). Угол сервиса, характеризует подвижность механизма при неподвижном схвате [1]. В [2] приведен способ определения указанного параметра на основе использования метода объемов. Однако при сложной структуре кинематических цепей манипуляторов, заданных предельных значений обобщенных координат и значении двигательной избыточности равной трем и более использование указанного способа затруднено.
Исследуем точность определения угла и> [3], который с определенным допущением определяет угол сервиса и, при использовании способа основанного на реализации мгновенных состояний, на примере плоского семизвенного механизма манипулятора, длины звеньев которого равны 120 мм. Геометрическая модель в соответствии с обозначением открытых кинематических цепей принятой в работе [4] будет следующей М3 -3-3-3-3-3-3. Для конфигурации указанного манипулятора, представленной на рис. 1а, угол сервиса и для заданной точки зоны обслуживания А2 графическими построениями определится пересечением двух
окружностей. Центры указанных окружностей совпадают с точками Оо и А2, а их радиусы равны соответственно 120-5=600 и 120 мм. Для конфигурации задающей положение центра схвата заданного точкой А2 (р=11.5°, р 2-5=0, ф6=90° ) указанный угол сервиса равен 169о, параметры ф1 - определяют значения обобщенных координат.
Определим угол и реализацией мгновенных состояний для конфигураций, при которых точка А1 (центр схвата) будет располагаться на отрезке А;А3, длина которого равна двум длинам последнего подвижного звена (А А = 240мм), при этом Ф2-5 = 0°. Рассмотрим семь различных положений указанной точки на отрезке А1 А3. Соседние точки А1 располагаем на расстоянии 30 мм. Способ определения угла и основан на построении конфигураций, удовлетворяющих заданной точности позиционирования центра выходного звена (которую обозначим величиной dmin ) реализацией значений векторов обобщенных скоростей 0( ф1, ф,..., фп ) [3 ]. Данные конфигурации удовлетворяют заданным погрешностям реализаций dmin. В работе при проведении исследований значение параметра dmin принято dmin < 1 мм. Значение вектора 2 определяется в соответствии с заданной линейной системой уравнений, задающей взаимосвязь обобщенных скоростей 2 со скоростями выходного звена манипулятора заданного вектором V [1]. Первоначальное направление век-
Рис. 1 Определение углов и и их: а - определение угла и с помощью графических построений, б - зона положений точек центров схвата для которых обеспечивается перемещения к целевой точке А1
при нахождении угла их
б
Рис. 2 Изображения конфигураций: а - синтез конфигураций с возникновением тупиковой ситуации, б - особые конфигурации. в - крайние положения конфигураций, г - анализ положения точек в,
относительно прямых а{
а
г
тора V при проведении исследований принято параллельным оси О0х0 неподвижной системы координат. Размерность указанного вектора при проведении исследований принята равной двум, т.е. ориентация выходного звена при синтезе движений не учитывается. При этом Ух = 1 мм/сек,
V = 0.
Строим совокупность конфигураций [3,4], для
-пк
которых значение угла и положительно и больше предыдущего значения икт1, рассчитанного на предыдущей итерации. Данный угол икт определяют выходные звенья двух
конфигураций рассчитанных на начальной и к-ой итерации (рис. 1а). Начальное положение конфигурации для точки А 2 соответствует значениям обобщенных координат р1=11.5°, р2_
5=0, р6=90° (см. рис. 1а). При этом для этой конфигурации принимается угол икт =0. После
определения конфигурации методом, изложенным в [3,4], и удовлетворяющей условиям:
' Г£+1 > 1сМ<с]пт, (1)
находят следующую конфигурацию к+2. При этом за исходно заданную конфигурацию принимается конфигурация к+1. Центр выходного звена после этого отклоняется на некоторую величину dd < dmin . При построении следующих конфигураций данная величина dd увеличивается и принимает значение dd > dmin. С целью уменьшения отклонения центра выходного звена от заданной точки а, зоны обслуживания (при синтезе малых движений), при выполнении условия dmin < dd< dmax необходимо рассчитать новое значение вектора Vц перемещения центра выходного звена к целевой точке Ai (рис. 1б). Данный вектор имеет
направление к целевой точки, а его модуль определяется величиной dd. Параметр dmax при проведении исследований принят 3 мм. После реализации вектора Vц происходит перемещение точки В7 к целевой точке А1. При этом вновь параметр dd принимает значение dd < dmin .
При построении конфигураций, удовлетворяющих условиям (1), с использованием алгоритма, изложенного в [3,5], могут быть случайным образом рассчитаны особые конфигурации, при которых происходит зацикливание и возникновение тупиковых ситуаций. Пример синтеза движений с возникновением тупиковой ситуации представлен на рис. 2а. Изображения некоторых особых конфигураций представлены на рис. 2б.
Как видно из рисунка, особые конфигурации возникают, когда центры вращательных шарниров заданные точками в, (три и более) начинают располагаться на одной и той же прямой а^ Прямые а{ определяются узловыми точками в, плоского манипулятора.
Например, прямая а1 определяется точками В1 и В2 , соответственно прямая а2 - точками В2 и В3, и т. д. (см. рис. 2б). Особые конфигурации возникают, если один из центров вращательных шарниров (точка В,) приближается к одной из прямых а. Заметим, что конфигурации задающие крайние положения звеньев манипулятора (см. рис. 1а и 2б) в качестве особых конфигураций не принимаются. Для обеспечения исключения ситуаций возникновения особых конфигураций при синтезе малых движений необходимо построение конфигураций с наложением условий на изменение той или иной обобщенной координаты. Это возможно благодаря заданию фиксированных значений определенным
обобщенным скоростям. При использовании указанных условий система расчета конфигураций изменяет определенным образом отдельные обобщенные координаты при синтезе движений. В этом случае, если среди точек В„ задающих текущую конфигурацию близкую к особой, пЗ -точек ВI близки к прямым а1 необходимо на пЗ значений обобщенных координат наложить условия. Например если центр пятого вращательного шарнира (точка В5 см. рис.2г) приближается к прямой а2 определяющей точками В2 и В3 необходимо изменять четвёртую обобщенную координату с заданной скоростью ф4 = ф45. В этом случае расстояние Ь5 меньше допустимого Ь5 < Ьдоп (см. рис. 2г).
Следовательно, необходимо на четвертую обобщенную координату наложить условие
ф4 = ф45, где за ф45 принятое фиксированное значение обобщенной координаты. В общем случае необходимо наложить условия на пЗ обобщенных координат. Например, если
расстояния Ь5 и Ьб меньше допустимого, необходимо наложить условия на следующие обобщенные координаты:
Ф4=Ф43 - Ф,=Ф>3 ■ (2)
Для однозначности расчета вектора 2 определяющего положение точки Мд еГ принадлежащей шестимерному пространству обобщенных скоростей, задаются п5
обобщенными скоростями, но при этом используются / = п — г — п5 уравнений гиперплоскостей А [3]. Параметры п и г соответственно определяют размерности векторов 2 и V. /-плоскость Г в многомерном пространстве обобщенных скоростей задает линейная система уравнений, отражающая взаимосвязь векторов 2 и
V. Для определения точки Мд для общего случая используются зависимости:
Ли Фи +Лг\ ф2( +... + Л п-п8фп_п8', -
Г, /),:
J2.lt Фи + J2.lt Ф2( + ••• + Л п-пЗ Фп-„81
= Уу+ Ву , (3)
где
В х = Л 16 Ф\б + J\. 26 Ф28 + ••• + Л пЗ Ф„5 \
В }•= J2. 16 Ф15 + Л 26 Ф28 + ... + Л пЗ Ф„8 (4)
В зависимостях (3-4) используются следующие величины: фп - обобщенные скорости на которые не накладываются дополнительные условия (2) (И 1. 2. ..., п - п,;). ф1(. - обобщенные скорости, на которые накладываются условия (2) (15 =
1 2, ■■■, пЗ X ^1, п-пЗ, ^2, п-пЗ, ^1, пЗ , ^2, пЗ - элементы
матрицы частных передаточных отношений I [1]. Уравнения (3-4) определяют новый критерий перемещения. При использовании указанных условий, система расчета конфигураций, позволяет обходить особые конфигурации. Заметим, что при проведении расчетов максимальное значение параметра п5 принималось равное двум.
Алгоритм построения конфигураций удовлетворяющих условиям (1-2) представлен на рис. 3. На рис. 3 используются обозначения: 1 -начало, задание вектора Ь„ (фь ср2, <рб); 2 -
вычисление точки А, зоны обслуживания; 3 -вычисление матрицы частных передаточных отношений I [1] и вектора 2; 4 - расчет
положения конфигурации // 1 , <р1 = <р1 + ф (принимается допущение А <р,ф. : 5 - вычисление точности позиционирования ёё; 6 - ёё < ёт,п; 7 -проверка условий ^шт > ^ > <^тах , где 40™, ^тах -заданные предельные значения обобщен-
а б
Рис. 4 Определение угла сервиса с помощью графических построений: а - (р1=11.5°, р2-5=0, рб=90° ); ' б-(<р1 = 7.4°, <р2.5=0, <р6=45.5°) '
123°
а б
Рис. 5 Определение угла из с помощью реализаций мгновенных состояний: а - (р1=11.5°, р2-5=0, ' <р6=9(Г); б-(<р1 = 7.4°, <р2.5=0, <р6=45.5°); '
Рис. 6 Графики зависимостей и = 1 (Ь), и /= /2 (Ь) ,и= /3 (Ь)
ных координат; 8 - икт > ; 9 - формирование
изображения конфигурации; 10 - изменение значений параметров кр (къ к2, ..., к4) координат точки N в р-плоскости Г [3] ; 11 - изменение номера итерации кк = кк + 1; 12 - ёё < ёётах; 13 -кктах = 200 ( кктах - предельно заданное число итераций); 14 - вычисление модуля вектора Уц в соответствии со значением ёё; 15 - проверка
условия Ь1 > Д”11 (анализ близости возникновения особых конфигураций); 16 - задание значений обобщенных скоростейфк- ; 17-конец.
При определении угла и и отсутствии синтеза движений с наложением условия (2), точность определения угла сервиса реализацией мгновенных состояний в зависимости от положения точки А і на отрезке А Аз составляет от
65 до 75 %. Результаты определения угла сервиса для двух заданных точек А, с помощью графических построений представлены на рисунке 4аб. Соответственно результаты расчета угла и реализацией мгновенных состояний без использования зависимости (2) представлены на рис. 5. На рис. 6 и 7 представлены графики зависимостей и= / (Ь), и \ = /2 (Ь), , /и ' =/3 (Ь) отражающие изменение угла сервиса и угла Щ для этого случая. Параметр Ь определяет удаление точки А, от точки А} (см. рис. 1а).
Здесь /л - точность определения угла сервиса реализацией мгновенных состояний. Значительное расхождение с углом сервиса объясняется наличием особых конфигураций, в которых происходит зацикливание и возникновение тупиковых ситуаций. Графики функций и= /2 (Ь)
и t=J. (L)
ч
fi щ 60 \ , н Ф
30 60 90 120 L А 150 ИМ 13'0 210 240
Рис. 7 График зависимостей /и =f4(L) , ц = f5 (L)
Рис. 8 Результаты определения угла а -(р,=11.5°, р2-5=0, рб=90° );
ил = /з (Ь) отражают определение угла V, и точность определения угла сервиса с использованием условий (2-3).
На рис. 8 представлен синтез малых движений при определении угла V, при использовании зависимостей (2-4). Анализ графиков функций показывает что отличие значений угла V, от угла сервиса составляет от 75 до 97 % в зависимости от положения центра захвата на отрезке А1 А3.
б
П при использовании условий (1-3) .
б -(р1 = 7.4°, р2-5=0, рб=45.5 ° );
Предлагаемый алгоритм определения V, , с определенным допущением задающий угол сервиса, характеризуется универсальностью и может быть использован для манипуляторов имеющих произвольную структуру плоских кинематических цепей, произвольную степень двигательной избыточности и заданные предельные значения обобщенных координат.
СПИСОК ЛИТЕРАТУРЫ
1. Кобринский, А. А. Манипуляционные системы роботов / А. А. Кобринский, А. Е. Кобринский. - М. : Наука. 1985. - 343 с.
2. Лебедев, П.А. Аналитический метод определения коэффициента сервиса манипулятора // Проблемы машиностроения и надежности машин. - 1991. - №5. - С. 93 - 98.
3. Притыкин, Ф.Н. Графическое представление телесного угла и окружающего пространства руки при реализации мгновенных состояний манипуляторов / Ф.Н. Притыкин // Проблемы машиностроения и надежности машин. - 2002. - №3.-С. 93 - 101.
4. Притыкин, Ф. Н. Методы и технологии виртуального моделирования движений адаптивных промышленных роботов с использованием средств компьютерной графики / Ф. Н. Притыкин // Мехатроника, автоматизация, управление. - 2011. - № 6. - С. 34 - 41.
5. Притыкин, Ф. Н. Анализ показателей маневренности механизмов манипуляторов, имеющих различную структуру кинематических цепей / Ф. Н. Притыкин, Е. А. Чукавов // Мехатроника, автоматизация, управление. - 2013. - № 1. - С. 35-39.
□ Авторы статьи:
Притыкин Федор Николаевич , д. т. н., доцент, проф. каф. инженерной геометрии и САПР (Омский гос.
техн. университет) , e-mail - [email protected]
Г ордеев Олег Игоревич, студент 2 курса РТФ (Омский гос.
техн. университет), e-mail - [email protected]
а
