CC BY
88
Расчет и конструирование
машин
УДК 621.01
Манипулятор параллельной структуры для поступательных перемещений с приводами, установленными на основании
А.В. Козырев, В.А. Глазунов
Все более широкое распространение получают механизмы и манипуляторы с параллельной структурой; их конструкции постоянно совершенствуются, появляются новые. Поэтому актуальным является исследование конструкций, имеющих некоторые специфические особенности и, соответственно, преимущества. В статье рассмотрен механизм параллельной структуры для поступательных перемещений, у которого все линейные приводы расположены в горизонтальной плоскости.
В результате исследования составлена матрица плюккеровых координат, получено решение задачи о положениях, выполнено построение рабочей зоны манипулятора, а также сформирован трехмерный объект, по которому можно оценить примерную форму и габаритные размеры построенной рабочей зоны.
Ключевые слова: манипуляторы параллельной структуры, плюкке-ровы координаты, обратная задача кинематики, рабочая зона.
A Manipulator of Parallel Structure for Translational Movement
A.V. Kozyrev, V.A. Glazunov
Parallel structure mechanisms are used in technological, testing, measurement systems. There are lot of schemas exist with different degrees of freedom, but it is relevant to investigate new solutions corresponding specific technical tasks.
In the paper, a parallel structure mechanism for translational movements is considered, in which all the linear actuators are situated in the horizontal plane.
The matrix consisting of the Pluecker coordinates is formed, the solution of the kinematic problem is obtained, the working zone of the manipulator is built, its shape and size are determined.
Keywords: manipulator of parallel structure, Pluecker coordinates, inverse problem kinematic, active area.
КОЗЫРЕВ Алексей Владимирович
(Институт машиноведения
им. А.А. Благонравова Российской академии наук)
KOZYREV Alexey Vladimirovich
(Moscow, Russian Federation, Institute of Machines Science named after A.A. Blagonravov of the Russian Academy of Sciences)
ГЛАЗУНОВ Виктор Аркадьевич (МГТУ им. Н.Э. Баумана)
GLAZUNOV Victor Arkadievich
(Moscow, Russian Federation, Bauman Moscow State Technical University)
/^реди механизмов параллельной структуры с несколькими кинематическими цепями, соединяющими основание с выходным звеном, особый интерес вызывают механизмы с поступательным движением выходного звена. Существуют разные способы построения кинематических цепей, обеспечивающих указанные поступательные движения [1—4].
В работе [5] предложена одна из возможных конфигураций манипулятора (рис. 1). Механизм состоит из основания и выходного звена, соединенных тремя идентичными кинематическими цепями, в каждой из которых расположен горизонтально линейный привод. Следует отметить, что, во-первых, здесь все приводы расположены в горизонтальной плоскости, а это упрощает конструкцию основания, во-вторых, присутствуют только вращательные кинематические пары, что увеличивает технологичность механизма. В упомянутой работе рассмотрены связи, налагаемые кинематическими цепями на движение выходного звена, получен вывод полной матрицы Якоби, однако отсутствует решение обратной задачи кинематики в явном виде и анализ рабочего пространства.
В данной статье составлена матрица плюк-керовых координат, ее анализ является одним из основных методов исследования механизмов параллельной структуры и позволяет решать следующие задачи: о сингулярностях, о скоростях, силовой анализ. Также в статье приведено решение
Рис. 1. Конструкция манипулятора
задачи о положениях и построение рабочей зоны манипулятора.
Формирование матрицы плюккеровых координат. Наиболее комплексным и универсальным методом исследования манипуляторов параллельной структуры является исследование кинематических и силовых винтов — векторов, характеризующих геометрию механизма, полученных методами винтового исчисления, а также матрицы плюккеровых координат, составленной из этих винтов [4, 6].
Единичный винт представляет собой вектор, содержащий шесть параметров: координаты единичных векторов, расположенных в каждой кинематической паре и момент каждого единичного вектора относительно центра координат. На основе единичных винтов определяются эквивалентные им силовые винты, необходимые для анализа манипулятора.
В предлагаемой работе исследуемый механизм состоит из трех кинематических цепей, в каждой из которых имеется одна поступательная кинематическая пара — линейный привод и четыре пассивные цилиндрические вращательные пары. Каждой кинематической паре соответствует единичный вектор, направленный вдоль оси кинематической пары. Момент единичного вектора относительно центра координат равен векторному произведению этого вектора и радиус-вектора, направленного от центра координат к центру кинематической пары. Из полученных данных составляют единичные винты, из которых с помощью линейных преобразований получают взаимные им силовые винты.
Добавление углов поворота а1, а2, а3 связано с необходимостью исключения особых положений механизма на всем рабочем пространстве: каждая кинематическая цепь ограничивает вращательное движение выходного звена только вокруг оси г, вокруг осей х и у возможно неконтролируемое вращение. Эти углы устанавливаются однократно и не изменяются при работе механизма.
Ниже приведен расчет силового винта, взаимного ортам осей кинематических пар одной из кинематических цепей. Поскольку кинематические цепи в механизме идентичны, то
расчет силовых винтов для остальных кинематических цепей выполняется аналогично.
Единичный вектор в поступательной кинематической паре имеет координаты
0
Радиус-вектор от центра координат к поступательной кинематической паре
/ Ь\
Р10 =
2
0 0
Момент единичного вектора поступательной кинематической пары относительно центра координат
eo 10 р10е10
'0\
0 0
Следует отметить, что в данном случае имеет место кинематический винт бесконечно большого параметра, моментная часть которого не зависит от точки приведения.
Единичный вектор в первой вращательной кинематической паре
' - \
1 0 0 (0)
е11 = ео8 а1 — 81п а1 0 1
^1п а1 ео8 а1 1 ,0/
0
■ а
ео8 а
1 /
Радиус-вектор от центра координат к первой вращательной кинематической паре
р0ц =
ео8
81П
\
п
"+6
п
п+6
0
0
■ 81П
п
п+6
ео8
\ п
п+6
\
ql
0 0
Ь ) 2 л/3Ь
0 ql
0
0 0
0
1 0 V 1/
0 1 /
0 1
Переходя к стандартной форме, получаем / Ь)
q 1 -
ри
2
43ь
6
0
\ /
Момент единичного вектора в первой вращательной кинематической паре относительно центра координат
ео11 = р11 Хе11 =
ео8 а.
\
-ео8 а
■ 81П а
6
х Ь 2 Ь
~2
q 1 ql
Единичный вектор во второй вращательной кинематической паре
е12 е11 .
Радиус-вектор от центра координат ко второй вращательной кинематической паре
Р012 =
X
1 0 0 Р110
0 ео8 а1 — 81п а1 р111
0 81п а1 ео8 а1 р112
0 0 0 1
ео8 ф11 — 81П ф11 0 0^
81п ф11 ео8 ф11 0 0
0 0 10
0 0 0 1
\
X
х0 )
11 0
Ь . . ql— —11й1П фц
1/
\
•х/ЭЬ
11 ео8 а1 ео8 ф11 — 11 ео8 а1 81п а1
Переходя к стандартной форме, получаем
6
6
Pl2
L . .
qi - 2 — lisln Фп
l1 cos a1 cos ф11 —
l1 cos a1 sln a1
Момент единичного вектора во второй вращательной кинематической паре относительно центра координат
eo12 р12 *e12
(, £L1 1
cos a1 l1 cos a1 cos ф11--;— +
6
+ cos ф11 sln a1
cos a
L
q 1 +11 sln ф11
sin a
L
— — q1 +11 sin фц
V /
Единичный вектор в третьей кинематической паре
(!) = 0 .
Vo^
Радиус-вектор от центра координат к третьей вращательной кинематической паре
P13 = P12 =
L . . q1— 2—11sln фп
i
l1 cos a1 cos ф1
V3l
11 6 l1 cos a1 sln a1
\
/
Момент третьего единичного вектора относительно центра координат
/ \
0
eo13 p13e13
l1 cos ф11 sln a1
V3l
—11 cos a1 cos ф11
Единичный вектор в четвертой кинематической паре
e14 = e13 •
Радиус-вектор от центра координат к четвертой вращательной кинематической паре
'10 0
0 cos ф12 — sln ф
0 sln ф12 cos ф1;
0 0 0
P014 =
P130 (0 \
P131 0
P132 12
1 U)
1
V3l
L . . q1— J —11sln фц
11 cos a1 cos ф11 — 12 sln ф12 —
12 cos ф12 +11 cos ф11 sln a1
Переходя к стандартной форме, получаем
P14
L . .
q 1— 2 —11sln фц
l1 cos a1 cos ф11 — 12 sln фг
1
43l
2 ф12 6 12 cos ф12 +11 cos ф11 sln a1 1
Момент четвертого единичного вектора относительно центра координат
eo14 P14 ^e14 0
12 cos ф12 +11 cos ф11 sln a1
V3l . ;
--h 12 sln ф12 —11 cos a1 cos ф11
1
6
Полученные плюккеровы координаты единичных винтов имеют следующие значения:
E10 (e10„ e101 e102 e E11 = (e110 e111 e112 e
o100
o110
o101 o10.
o111 bo11,
E12 = (e120 e121 e122 eo120 eo121 eo122 ) E13 = (e130 e131 e132 eo130 eo131 eo132 ) E14 _ (e140 e141 e142 eo140 eo141 ^o142-
6
6
2
)
e
)
e
6
где
Еп =
Е10 = (1 0 0 0 0 0);
/ . "Узь
^0 — 81п а1 ео8 а1----
-ео8 а1|q1 — — | — 8Ш а!
ql
Остальные выражения не приведены, так как имеют более сложный характер.
Далее, путем решения системы из пяти уравнений, выражающих относительные моменты силового и кинематических винтов, определяется силовой винт, взаимный пяти полученным единичным винтам. Указанные относительные моменты должны быть равны нулю, т. е. винты взаимны. У силового винта шесть составляющих, а уравнений пять. Однако, поскольку плюккеровы координаты определяются с точностью до множителя (так как они являются коэффициентами линейной системы уравнений, и их изменение в одно и то же число раз не влияет на результат), то одна из координат задается произвольно, но таким образом, чтобы система уравнений имела решения, и решение было бы ненулевым.
Система уравнений силового винта имеет следующий вид:
Го1хе100 + Го1 уе101 + ro1zeW2 + Г1 х е о100 + Г1уео101 + +г1 гео1С2= 0;
Го1хе110 + Го1 уе111 + Го1ге112 + Г1 хео11, +г1 zeoll2 =0;
Го1хе120 + Го1 уе121 + Го1ге122 + Г1 хе
+г1 0122= 0;
Го1хе130 + Го1 у е131 + Го1ге132 + Г1 х е о130 + Г1уео131 + +г1 гео1з, =0;
+ ги,е
1^о111
+
х - о120 + Г1уео121 +
Го1хе140 + Го1 уе141 + Го1 ге142 + Г1 хе +Г1 ^14, = 0.
+ г, уе
1 у о141
+
Произвольная координата силового винта
Гои = 0.
Решение системы уравнений и формирование первого силового винта первой кинематической цепи имеет вид
Я =
0\ 0 0 0 0
|ео1 аь
Таким образом найден силовой винт, взаимный пяти единичным винтам первой кинематической цепи. Выполнив аналогичные вычисления для оставшихся двух кинематических цепей, можно получить матрицу плюккеровых координат, строки которой содержат найденные координаты силовых винтов:
Я =
000
0
л/3 ео1 а 2
л/3 ео1 а 3 2
ео1 а1
ео1 а 2
2 ео1 а 3
2
\
1 1
1
Поскольку в полученной матрице плюкке-ровых координат манипулятора присутствует только моментная часть, то кинематические цепи ограничивают только вращение платформы вокруг трех осей. Из этого следует, что механизм имеет три поступательные степени свободы.
Решение обратной задачи кинематики. Целью решения обратной задачи кинематики является нахождение положений всех приводов при заданном положении подвижной платформы. Для каждой кинематической цепи расчет выполняется отдельно.
Решение сводится к поиску условий, при которых координаты точки в месте соединения двух звеньев рассматриваемой кинематической цепи, полученные геометрически при отсчете от центра платформы, были бы равны координатам этой же точки, полученным при отсчете от привода. Решение аналогично для всех кинематических цепей, за исключением того, что в различных кинематических цепях используют соответствующие точки крепления звеньев к платформе и вычисления выполняют в локальных системах координат, таких, что положение соответствующего привода в них одинаково.
Рассмотрим решение для одной из трех кинематических цепей. Переход от центра плат-
формы к точке крепления второго звена первой кинематической цепи осуществляется отрицательным смещением по оси у на расстояние г:
Л/ 0 \ / х \
X1 =
00 1 0 0 1 00
0
\1/
\
х У — Г z 1
Переход от первой точки платформы к точке соединения двух звеньев выполняется поворотом на угол ф2 первой кинематической цепи вокруг оси х и отрицательным смещением по оси г на /2:
0
A =
0
cos ф12 sln ф12 0
- sln ф12 cos ф12 0 х
y — r +12 sln ф12 z — l2cosф12 1
х \ Í 0 )
y— r 0
z —12
1 / 11)
1
Далее необходимо найти координаты этой же точки относительно центра координат. Определим положение привода первой кинематической цепи относительно центра координат, находящегося в центре равностороннего треугольника со стороной Ь, лежащего на основании. Это осуществляется пово-7п
ротом на угол — вокруг оси г первой кинема-6
тической цепи и положительным смещением по оси х на Я:
cos
sln
\
п
п+6
п
п+6
0
0
— sln
п
п+6
cos
\
п
п+6
0
0
1
0х
\
0
1 0
ч1
q1
L \ 2 V3L
6 0 1
Переход от точки привода к точке соединения двух звеньев осуществляется поворотом на угол а вокруг оси х первой кинематической цепи, поворотом на угол ф1 вокруг оси г второй кинематической цепи и положительным смещением по оси у на /1:
B =
0
cosa
0 sln a
0
— sln a1
cosa
x
0
cos ф11 sln ф11 0
0
/
q1 —
— sln ф11 0 х
cos ф11 0 0
0 1 0
0 0 1
q1a1 q11
q12 1
l1 0
\1/
x
L 2
■ l1 sln ф11
l1 cos a1 cos ф11
V3l
6
l1 cos ф11 sln a1 ,1
Далее необходимо приравнять координаты точки соединения двух звеньев первой кинематической цепи, определенные двумя способами и решить полученную систему уравнений:
L . . х = q 1 — 2 — A sln фи;
y — r +12 sln ф12 = l1 cos a1 cos ф11
V3L 6 ;
z — l2cosф12 = l1 cos ф11 sln a1 • Из формулы (3) следует
Z — 12Cosфl2
cos ф11 =—,—■-•
l1 sln a1
Подставив (4) в (2), получим уравнение y — r +12 sln ф12 =
z — l2cosф12 V3L
(1)
(2)
(3)
(4)
(5)
= l1 cosa1
l1 sln a1
6
которое имеет два решения. Однако, поскольку одно из них соответствует положению, при котором манипулятор находится под основанием, это решение не учитывается в дальнейшем.
0
0
0
q
2
1
Решение уравнения (5) имеет вид
ф12 = п + а1 +
+агеео8
1
— 81па1
I 2
у — Г +
43-
\
6
— г ео8 а
/
(6)
Из уравнения (4) получаем два значения угла поворота второго звена относительно под-
вижной платформы. Одно из них соответствует положению привода до прохождения центра Ь, другое — после:
ф11 = ±агеео8
'г — 12еовф12 \
11 81П а1
(7)
Окончательно решение системы уравнения (1)—(3) можно представить в следующем виде:
81П а
у — г +
43-
а1 ±агеео8-
\ \\
- — г ео8 а1 /
2
Ь
ql = -у + х — А
Таким образом получено выражение, содержащее зависимость между координатами подвижной платформы и положением привода первой кинематической цепи. Выполнив ана-
//
/1 81п а12
логичные расчеты для двух оставшихся кинематических цепей, получим следующие выражения:
Ьх
q 2 = Т — 2 —11
81П а
у
+ г-
43- 43:-\
х
\\
+ г ео8 а 2
а 2 + а ео8-
/
//
43у
/1 81п а 2
6
2
2
6
2
2
2
2
2
Ьх
q 3 = 2 — 2 —11
/1 81п а 32
Анализ рабочего пространства. Рабочее пространство — один из важнейших критериев для оценки характеристик манипулятора [4]. Поскольку аналитически определить свойства данного манипулятора весьма затруднительно, так как невозможно найти общее решение прямой задачи кинематики, необходимо вычислить доступное рабочее пространство, используя найденное решение обратной задачи кинематики. Результаты, полученные в про-
цессе моделирования для манипулятора, представлены на рис. 2.
Поскольку анализ массива точек в трехмерном пространстве является затруднительным по причине отсутствия наглядности изображения, к полученному множеству была построена выпуклая оболочка, «натянутая» на это множество. В результате было получено изображение трехмерного объекта (рис. 3), анализ и исследование которого является более простой задачей. Недостаток такого метода состоит в том,
Рис. 2. Рабочая зона
что полученная трехмерная фигура не отображает возможные вогнутые участки области, поэтому не является точным подобием рабочей зоны, однако позволяет оценить примерную ее форму и габаритные размеры.
Литература
1. Merlet J.P. Parallel robots. Kluwer Academic Publishers, 2000. 372 р.
2. KongX., Gosselin C. Type Synthesis of Parallel Mechanisms. Springer, 2007. 275 р.
3. Tsai L.-W. Robot analysis: the mechanics of serial and parallel manipulators. John Wiley & Sons, 1999. 505 р.
4. Глазунов В.А, Колискор А.Ш, Крайнев А.Ф. Пространственные механизмы параллельной структуры. М.: Наука, 1991. 95 с.
5. Bamberger H., Wolf A., Shoham M. Architectures of Translational Parallel Mechanism for MEMS Fabrication / The 12-th World Congress IFToMM, June 18—21, Besançon, France, 2007. 6 р.
6. Глазунов В.А. Структура пространственных механизмов. Группы винтов и структурные группы // Справочник. Инженерный журнал. 2010. Приложение № 3. 24 с.
Рис. 3. Изображение «оболочки» рабочей зоны
References
1. Merlet J.P. Parallel robots. Kluwer Academic Publishers, 2000. 372 p.
2. Kong X., Gosselin C. Type Synthesis of Parallel Mechanisms. Springer, 2007. 275 p.
3. Tsai L.-W. Robot analysis: the mechanics of serial and parallel manipulators. John Wiley & Sons, 1999. 505 p.
4. Glazunov V.A., Koliskor A.Sh., Krainev A.F. Prostranstvennye mekhanizmy parallel'noi struktury [The spatial arrangements of parallel structure]. Moscow, Nauka publ., 1991. 95 p.
5. Bamberger H., Wolf A., Shoham M. Architectures of Translational Parallel Mechanism for MEMS Fabrication. The 12-th World Congress IFToMM, june 18—21, Besancon, France, 2007. 6 p.
6. Glazunov V.A. Struktura prostranstvennykh mekhanizmov. Gruppy vintov i strukturnye gruppy [The structure of spatial mechanisms. Group of screws and structural group]. Spravochnik. Inzhenernyizhurnal. [Handbook. An Engineering Journal]. 2010, app no. 3. 24 p.
Статья поступила в редакцию 18.04.2013
Информация об авторах
КОЗЫРЕВ Алексей Владимирович (Москва) — аспирант кафедры «Прикладная механика». ИМАШ им. А.А. Благонравова РАН (101990, Москва, Российская Федерация, Малый Харитоньевский переулок, д. 4, e-mail: [email protected]).
ГЛАЗУНОВ Виктор Аркадьевич (Москва) — доктор технических наук, доктор философских наук, профессор кафедры «Компьютерные системы автоматизации производства». МГТУ им. Н.Э. Баумана (105005, Москва, Российская Федерация, 2-я Бауманская ул., д. 5, стр. 1, e-mail: [email protected]).
Information about the authors
KOZYREV Alexey Vladimirovich (Moscow) — Post-Graduate of «Applied Mechanics» Department. Institute of Machines Science named after A.A. Blagonravov of the Russian Academy of Sciences (Maly Kharitonyevsky Pereulok, 4, 101990, Moscow, Russian Federation, e-mail: [email protected]).
GLAZUNOV Victor Arkadievich (Moscow) — Dr. Sc. (Eng.), Dr. Sc. (Philos.), Professor of «Computer Systems of Production Automation» Department. Bauman Moscow State Technical University (BMSTU, building 1, 2-nd Baumanskaya str., 5, 105005, Moscow, Russian Federation, e-mail: [email protected]).
