книги / Эффективные методы решения задач кинематики и динамики робота-станка параллельной структуры
..pdf2.5. Оптимизация траектории движения рабочего инструмента |
61 |
|||||||
Т а б л и ц а |
2,1, Длины штанг при прямолинейном движении рабочего |
|
||||||
|
|
|
|
инструмента |
|
|
|
|
t |
L |
|
L 2 |
L 3 |
L4 |
L 5 |
L6 |
|
0 |
109,157 |
109,157 |
109,157 |
109,157 |
109,157 |
109,157 |
|
|
0,05 |
109,624 |
110,098 |
109,896 |
110,991 |
106,229 |
107,011 |
|
|
0,1 |
110,004 |
110,908 |
110,799 |
112,821 |
103,332 |
104,906 |
|
|
0,15 |
110,301 |
111,59 |
111,846 |
114,629 |
100,482 |
102,854 |
|
|
0,2 |
110,519 |
112,144 |
113,022 |
116,399 |
97,6929 |
100,865 |
|
|
0,25 |
110,663 |
112,575 |
114,306 |
118,115 |
94,9819 |
98,9489 |
|
|
0,3 |
110,738 |
112,888 |
115,681 |
119,765 |
92,3633 |
97,115 |
|
|
0,35 |
110,752 |
113,089 |
117,127 |
121,337 |
89,8513 |
95,3705 |
|
|
0,4 |
110,714 |
113,184 |
118,627 |
122,823 |
87,4587 |
93,7212 |
|
|
0,45 |
110,631 |
113,181 |
120,162 |
124,214 |
85,1974 |
92,1716 |
|
|
0,5 |
110,514 |
113,089 |
121,717 |
125,503 |
83,0778 |
90,7241 |
|
|
0,55 |
110,372 |
112,916 |
123,276 |
126,687 |
81,1083 |
89,3797 |
|
|
0,6 |
110,215 |
112,674 |
124,824 |
127,761 |
79,2957 |
88,1374 |
|
|
0,65 |
110,054 |
112,372 |
126,349 |
128,724 |
77,6444 |
86,9944 |
|
|
0,7 |
109,9 |
112,022 |
127,838 |
129,573 |
76,157 |
85,9464 |
|
|
0,75 |
109,762 |
111,634 |
129,281 |
130,31 |
74,8335 |
84,9873 |
|
|
0,8 |
109,652 |
111,22 |
130,669 |
130,935 |
73,6717 |
84,1098 |
|
|
0,85 |
109,577 |
110,791 |
131,994 |
131,449 |
72,6673 |
83,3054 |
|
|
0,9 |
109,549 |
110,358 |
133,25 |
131,857 |
71,8143 |
82,5646 |
|
|
0,95 |
109,574 |
109,933 |
134,431 |
132,162 |
71,1047 |
81,8771 |
|
|
1 |
109,66 |
109,526 |
135,532 |
132,367 |
70,5294 |
81,2324 |
|
|
будет оптимальна. Используя кинематические |
зависимости векто |
|||||||
ров |
штанг |
от |
положения |
рабочего органа и углов наклона, мож |
||||
но получить |
выражения, |
устанавливающие связь |
между |
временем |
t, |
64 Гл. 2. Кинематический анализ механизмов параллельной структуры
|
Т а б л и ц а |
2.2. Значения длин штанг при оптимизации траектории |
||||
t |
L\ |
L2 |
L3 |
L4 |
L5 |
L6 |
0 |
\09,\57 |
\09,\57 |
109,157 |
109,157 |
109,157 |
109,157 |
0,05 |
\09,\82 |
\09,\75 |
110,476 |
110,318 |
107,226 |
107,761 |
0 ,\ |
\09,207 |
\09,\94 |
111,795 |
111,478 |
105,294 |
106,365 |
0,\5 |
\09,232 |
109,212 |
113,113 |
112,639 |
103,363 |
104,968 |
0,2 |
\09,258 |
109,231 |
114,432 |
113,799 |
101,431 |
103,572 |
0,25 |
\09,283 |
109,249 |
115,751 |
114,960 |
99,5001 |
102,176 |
0,3 |
\09,308 |
109,268 |
117,070 |
116,120 |
97,5687 |
100,780 |
0,35 |
\09,333 |
109,286 |
118,388 |
117,281 |
95,6373 |
99,3834 |
0,4 |
\09,358 |
109,305 |
119,707 |
118,441 |
93,7060 |
97,9872 |
0,45 |
\09,383 |
109,323 |
121,026 |
119,602 |
91,7746 |
96,5909 |
0,5 |
\09,409 |
109,342 |
122,345 |
120,762 |
89,8432 |
95,1947 |
0,55 |
\09,434 |
109,360 |
123,663 |
121,923 |
87,9118 |
93,7985 |
0,6 |
\09,459 |
109,378 |
124,982 |
123,083 |
85,9804 |
92,4022 |
0,65 |
\09,484 |
109,397 |
126,301 |
124,244 |
84,0491 |
91,0060 |
0,7 |
\09,509 |
109,415 |
127,620 |
125,404 |
82,1177 |
89,6098 |
0,75 |
\09,534 |
109,434 |
128,938 |
126,565 |
80,1863 |
88,2136 |
0,8 |
\09,559 |
109,452 |
130,257 |
127,725 |
78,2549 |
86,8173 |
0,85 |
\09,585 |
109,471 |
131,576 |
128,886 |
76,3235 |
85,4211 |
0,9 |
\09,6\0 |
109,489 |
132,895 |
130,046 |
74,3922 |
84,0249 |
0,95 |
\09,635 |
109,508 |
134,213 |
131,207 |
72,4608 |
82,6286 |
\ |
\09,660 |
109,526 |
135,532 |
132,367 |
70,5294 |
81,2324 |
Если существуют такие x , y, |
z, ц>, $, |
£, при которых длины |
штанг L \ , |
Ь 2, . . . , Ь б, равны соответственно, то значит возможны перемещения из точки t i в t i+\.
Результаты расчетов численным методом Ньютона в этом случае приведены в табл.2.2 и на рис. 2. \ \ . Погрешность перемещения рабо чего инструмента составила не более 0,\% от длины штанги.
Глава 3
д и н а м и ч е с к и й а н а л и з п р и в о д н ы х м е х а н и з м о в д л я м п с
Рассмотрим три наиболее распространенных и одновременно наи более простых в конструктивном исполнении типов исполнительных механизмов: электромеханические с передаточной парой «винт-гайка», параллелограммным механизмом и электрогидравлический.
3.1.Электромеханический исполнительный механизм
спередаточной парой «винт-гайка»
3.1.1.Характеристика исполнительного механизма. Передачи «винт-гайка» применяют в различных машинах и механизмах для пре образования вращательного движения в поступательное. В ряде случа ев эти передачи используют для получения большого выигрыша в силе.
Достоинства передач «винт-гайка»: возможность получения медленно го движения и высокой точности перемещений при простой и недорогой конструкции передачи, большая несущая способность и компактность. Недостаток передачи — низкий КПД.
Исполнительный механизм такого типа изображен на рис. 3.1.
Для использования передачи «винт-гайка» в данном типе испол нительного механизма требуется реверсивный вращательный электро двигатель постоянного тока с независимым возбуждением. В первом приближении можно принять, что относительная скорость пропорцио нальна управляющему сигналу, т. е. z = K u .
Более глубокий анализ динамики потребует учета электромехани ческих и электромагнитных свойств электродвигателя, управляющей электрической цепи и самотормозящейся пары.
Привод, кроме того, включает акселерометры, датчик относитель ного перемещения, регулятор, усилитель мощности, электродвигатель
постоянного тока.
Электрические сигналы акселерометров и датчика относительного перемещения поступают в регулятор, сигнал из которого поступает на вход электрической следящей системы, управляющей поворотом ротора двигателя. Двигатель вращает винт, и гайка перемещается в направля ющем элементе, изменяя положение объекта относительно основания. Ходовая резьба в паре «винт-гайка» является самотормозящейся, чем
В,!. Электромеханический исполнительный механизм,,. |
67 |
Рис. 3.1. Система с электромеханическим исполнительным механизмом и пе редаточной парой «винт-гайка»: 1 — объект, 2 — основание, 3, 4 — акселе рометры на объекте и основании, 5 — датчик относительного перемещения, 6 — регулятор, 7 — электродвигатель, 8 — усилитель мощности, 9 — ходовой винт, 10 — гайка
достигается нечувствительность предлагаемой системы к силам, дей ствующим со стороны объекта. Наличие направляющих в механизме обеспечивает отсутствие проворота гайки [1 1 ].
3.1.2. Разработка математической модели. Исходя из требова ний, предъявляемых к системе, и рекомендаций по расчету передачи «винт-гайка» [5], составим таблицу исходных технических данных для расчета передачи «винт-гайка» (табл. 3.1).
Средний диаметр резьбы dcp, высота профиля резьбы h и шаг резьбы P могут быть определены, исходя из следующих формул:
dcp = J |
, h = о, Idcp, P = 2h. |
3*
68 Гл. 3. Динамический анализ приводных механизмов для МПС
Т а б л и ц а 3.1. Исходные технические данные для расчета передачи «винт-гайка»
№п/п |
Наименование характеристики и обозначение |
Единица |
Значение |
|
измерения |
||||
1 |
Максимальная грузоподъемность, (Fmax) |
кН |
100 |
|
2 |
Отношение высоты гайки к среднему |
— |
1,6 |
|
диаметру резьбы, (k) |
||||
|
|
|
||
3 |
Допускаемое давление для резьбы (для |
МПа |
10 |
|
закаленной стали по бронзе), (q) |
||||
|
|
|
||
4 |
Число заходов резьбы, (n) |
— |
3 |
|
|
Коэффициент трения в паре «винт-гайка» |
|
|
|
5 |
(для случая сталь 45 по бронзе |
— |
0,1 |
|
|
БрОЦС6-6-3), (f) |
|
|
|
6 |
Угол профиля резьбы (для |
град |
30 |
|
трапецеидальной) (а) |
||||
|
|
|
Далее определяем угол подъема винтовой линии ф, приведенный коэффициент трения f ' и приведенный угол трения ф'\
Ф = arctg ( |
j , f ' = |
f - , ^ = arctg f |
\ жаср; |
|
cos^ - j |
Теперь можно определить передаточные числа передачи по скоростным и силовым параметрам соответственно:
П = П- > г- = 1 d ■tg (ф + v ' ) .
В рассматриваемом типовом случае после проведения вычислений получились следующие значения этих величин: ri = 6,207 х 10~3 м и г- = 9,665 х 10~ 3 м.
При построении модели электродвигателя постоянного тока с неза висимым возбуждением в качестве входной величины будем рассмат ривать напряжение якоря, а в качестве выходной величины — угловую скорость вращения вала двигателя. Реально электродвигатель посто янного тока описывается нелинейными уравнениями, и нелинейность математического описания обусловлена следующими факторами:
—момент сопротивления на валу двигателя зависит от скорости вращения, и эта зависимость нелинейна;
—поле возбуждения электродвигателя формируется в результате взаимодействия магнитных полей обмоток возбуждения и обмоток
В,!. Электромеханический исполнительный механизм,,. |
69 |
якоря, а зависимость этого поля от напряжения на обмотках возбуж дения и якоря нелинейна;
— наличием зоны нечувствительности двигателя.
При построении модели двигателя для целей управления этими факторами можно пренебречь, так как модель отражает только наи более существенные связи для узкого диапазона управленческих воз действий. В связи с этим при построении модели примем следующие упрощающие предположения:
—поле возбуждения считается постоянным при постоянном напря жении возбуждения;
—момент сопротивления на валу двигателя не зависит от скорости вращения якоря;
—работа двигателя проходит вне зоны нечувствительности.
Кроме того, будем считать, что в данной системе:
—объект является жесткой массой;
—во всех элементах, кроме передачи «винт-гайка», трение отсут ствует;
—зазоры в кинематических парах также отсутствуют.
Электродвигатель постоянного тока с независимым возбуждени ем имеет: возможность регулирования частоты вращения в широком диапазоне, линейность механической и регулировочной характеристик, высокое быстродействие, малую массу и объем на единицу получаемой мощности и более высокий КПД. Запишем два электромеханических уравнения:
уравнение моментов |
|
—JSAш + кЭм1Я= М , |
(3.1) |
и уравнение якорной цепи |
|
Ы я + Ш я + &эм^ = U , |
(3.2) |
где M c — момент сопротивления на валу двигателя, 7эд — момент инерции ротора двигателя, 1я — ток якоря, L — индуктивность якорной обмотки, R — сопротивление якорной обмотки, кэм — электромагнит ный коэффициент электродвигателя, ш — скорость вращения якоря двигателя, U — напряжение на якоре двигателя.
В передаче «винт-гайка» модель передачи скоростей и момента описывается уравнениями:
z = шг 1, |
(3.3) |
Мс = FCT2, |
(3.4) |
где FC — сила сопротивления, которая может быть определена, исходя из выражения
F C = mz. |
(3 .5 ) |
70 Гл. 3. Динамический анализ приводных механизмов для МПС
Из уравнений (3.1)-(3.5) может быть получена система уравнений
- J 3A----+ k3MI B — m z r 2, |
|
|
Г1 |
(3.6) |
|
L I я + R In + кэм — U' |
||
|
||
r i |
|
Приведем уравнения (3.6) к виду, характерному для уравнений, описы вающих систему в пространстве состояний
|
|
|
|
|
z — |
кэмГ1 |
|
|
| |
|
|
|
|
|
|
|
--- -LR; |
|
|
||||
|
|
|
|
|
|
Jэд + mri'r-2 |
, |
|
|
(3.7) |
|
|
|
|
|
|
Т |
кэм • |
Д Т |
1 |
|
||
|
|
|
|
|
|
|
|||||
|
|
|
|
|
I я = |
------г z — -f I я + |
у и - |
|
|
||
|
|
|
|
|
|
r 1L |
L |
|
L |
|
|
Введем |
две |
переменные состояния: |
Х1 — Z, Х2 — 1я. Система |
уравне |
|||||||
ний |
(3.7) примет вид: |
|
|
|
|
|
|
|
|||
|
|
|
|
|
|
кэмГ1 |
|
|
|
|
|
|
|
|
|
Х 1 |
Jэд + тг1Г2 Х2 , |
|
|
|
|||
|
|
|
|
• |
|
к эм |
Д |
| |
1 |
|
|
|
|
|
|
Х2 = |
ГХ1 - |
—Х2 + у U, |
|
|
|||
|
|
|
|
|
|
r 1 L |
L |
|
L |
|
|
или в векторно-матричной форме |
|
|
|
|
|
||||||
|
|
|
|
|
|
X — A X + Bu, |
|
|
(3.8) |
||
|
|
|
|
|
|
Z — C X , |
|
|
|
||
|
|
|
|
|
|
|
|
|
|
||
где |
X |
|
Х 1 |
вектор |
состояния; |
B |
0 |
матрица |
входа; |
||
|
1 |
||||||||||
|
Х2 |
||||||||||
|
|
|
|
|
|
|
|
L |
|
|
|
|
|
0 |
|
кэмr 1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||
A — |
|
кэм |
|
J эд + тГ1Г2 |
матрица коэффициентов системы; |
|
|||||
|
|
|
Д |
. |
|
|
|
|
|
|
|
|
|
П ь |
|
— L |
|
|
|
|
|
|
|
C — [1 |
0 |
— матрица выхода. |
|
|
|
|
|
||||
Система |
уравнений |
(3.8) полностью описывает |
поведение электро |
механического исполнительного механизма с передачей «винт-гайка». Каждой конкретной модели электродвигателя соответствует своя мат рица коэффициентов системы A и своя матрица входа B.
От описания системы в пространстве состояний перейдем к пере даточной функции, описывающей влияние напряжения на якоре и на
скорость поступательного движения винта Z |
|
а д , (s) — 4 4 — с а д |
в , |
u (s) |
|
где $ ( s ) — (sI —A ) 1 — переходная матрица |
состояния. |
После проведения соответствующих вычислений можно получить
_______________ кэмГ1_______________
а д , (s)
L J + m r m ) s 2 + Д J + т г 1 Г2 ) s + к2ш