книги / Механика промышленных роботов и манипуляторов с электроприводом
..pdfВремя разгона и торможения по аналогии с выражениями (8.5) и (8.10):
/„ ---------- -f |
H |
■ ( / „ + |
/ ' * ' > . |
|
р |
. . i - |
МЛ |
" |
д |
|
Д н |
|
|
|
|
<рД . Н |
( / „ + |
|
|
*т |
Мл |
|
|
|
|
|
|
||
|
д . н * ‘ +' * с * ‘ |
|
Время отработки с учетом (8.11) можно найти следующим образом:
|
V о 1 |
ф М U +J ' V) |
||
*ош |
+ *Д-н Д . н \ н ^ д |
|||
" д . н |
МД ^ |
мл |
||
|
||||
|
|
|
Тогда выражение для оптимального по быстродействию передаточного
отношения имеет вид |
|
|
|
||||
2ф2 |
J |
н |
1 |
1-М/2/ у < " п У н > |
|
||
- |
J L-H |
|
|
(8.19) |
|||
' ОПТ Л |
*лн'*о |
М{1-[Л/с/(Л/д.н О]2} |
|||||
|
Вычислять /опт целесообразно методом последовательного приближе ния.
Для оценки мощности электродвигателя можно исходить из следующе го. Двигатель должен обеспечить определенную номинальную скорость фн перемещения по координате. Тогда требуемая скорость электродвигателя
$>д - ii>H |
(8.20) |
Ускорение движения по координате следует ограничивать некоторым допустимым значением фдоп. Слишком большое значение $ доп вызовет высокие динамические нагрузки на механизм привода, что приведет к преждевременному выходу из строя всего робота. С учетом этого момент
двигателя |
|
|
|
|
|
М |
J ф |
+ М |
Jt |
|
|
_ н ^ д о п |
--------с + |
д о п |
( 8.21) |
||
д |
iy |
|
|
||
|
|
|
|||
|
|
|
|
Можно принять для выражения (8.21 ) / д - / н/ (i h )), что обычно близко к действительности. В результате с учетом (8.20) и (8.21) получаем сле дующее выражение для расчета мощности электродвигателя:
2J^V„n„+Mn |
|
н г д о п С |
( 8.22) |
|
iy
Так как промышленный робот в процессе работы выполняет разнообраз ные циклы, передаточное отношение ПУ, рассчитанное на конкретное зна чение перемещения, не будет являться оптимальным для других значений перемещений. Ниже представлены результаты расчета по уравнениям (8.11)—(8.13) влияния отклонения передаточного отношения ПУ от опти мального на время отработки и соответствующие этим передаточным отно шениям углы, для которых процесс будет оптимальным.
i/iопт |
1.5' 1 |
1,2' 1 |
1,2 |
1,5 |
'(/'опт- % |
11 |
4 |
3 |
|
<р/<р0 |
3,375 |
1,728 |
0,588 |
0,296 |
Из анализа результатов расчета следует важный вывод. В значительном диапазоне изменения угла отработки отклонение процесса от оптимального невелико, поэтому передаточное отношение ПУ можно рассчитывать, ори ентируясь на какое-либо одно важное с точки зрения быстродействия и наиболее “нагруженное” перемещение. Иначе передаточное отношение ПУ можно рассчитывать, ориентируясь не на конкретное значение переме щения, а на среднее арифметическое всех перемещений у>0 ср, составляю щих цикл:
1 |
п |
Фо. с р“ 7Г |
f _ V o k ■ |
где (p0iç— угол отработки к-го перемещения в типовом цикле, состоящем из п последовательных перемещений.
Момент инерции / н* и статические моменты Мск нагрузки в каждом из перемещений также могут различаться. В расчетных формулах передаточ ного отношения ПУ следует использовать средние арифметические значе
ния этих величин: |
|
|
^ 1 п |
_ |
1 п |
^ н . с р “ И |
^ с . с р |
n ^ i ^ c k * |
Для электропривода с линейным перемещением исполнительного звена во всех расчетных формулах надо заменить моменты инерции нагрузки / н массой шн (кг) перемещаемых тел; статические моменты Мс—статически ми силами /^(Н ); характеристики угловых движений исполнительного звена <PQ, ^ M,ÿp, фт — соответствующими характеристиками линейных движений 50(м), VM(M/ C), ур(м/с2), VT(M/ C2). В этом случае передаточное отношение ПУ, представляемое как отношение скорости вращения элект родвигателя к скорости исполнительного звена, измеряется в радианах на метр.
На основе изложенного можно составить следующую краткую методи ческую схему выбора электродвигателя и передаточного отношения ПУ.
1. Ориентировочный расчет по данным технического задания наиболь шей требуемой мощности электродвигателя (формулы (8.18), (8.22)).
2.Выбор подходящих по мощности электродвигателей с различными значениями фдн и Мд
3.Расчет передаточных отношений ПУ для каждого электродвигателя (формулы (8.12), (8.17), (8.18)).
4.Выбор двигателя, обеспечивающего наиболее компактную‘конст рукцию электропривода и требуемое время отработки какого-либо наибо лее важного с точки зрения быстродействия перемещения или наименьшее время отработки типового цикла перемещений.
8.8. Выбор электродвигателя и передаточного отношения редуктора при контурном режиме работы
При контурном режиме работы промышленного робота энергетические параметры электродвигателя и передаточное отношение ПУ должны обес печивать наибольшие требуемые значения угловой скорости фн к и углового ускорения ÿ H^исполнительного органа и полезного груза. При этом пред полагается, что значение фнк и <рн к достигаются одновременно (наиболее тяжелый для привода режим). Тогда требуемые максимальные значения скорости <рл м , момента Л/д м и мощности Рд м электродвигателя определя ются следующим образом:
<Рд • м |
|
кр |
|
|
(8.23) |
U |
_J |
(6и . к + Мс |
|
н. к, |
(8.24) |
|
IV |
|
|||
Д . м |
|
|
|
|
|
|
|
J |
ф |
к+* с |
|
|
= |
Л/Д •м * д . м =( |
ну н |
(8.25) |
|
Д . м |
V |
к>*>н |
В выражении (8.23) фд м является требуемой максимальной скоростью электродвигателя при развитии им максимального момента. В уравнения (8.24) и *8.25) подставляются наибольшие значения / ни М с .
Эле /родвигатель и перадаточное отношение ПУ с энергетической точ ки зрения выбраны удовлетворительно, если одновременно выполняются
следующие два условия: |
|
|
Д/Д . мs |
М Д • |
(8.26) |
<Рн.р = |
*>Н.1 |
(8.27) |
где р — скорость перемещения исполнительного органа; <рц |
р--скорость |
|
электродвигателя при максимальном требуемом моменте. |
|
Расчет начинается с определения ориентировочного значения требуе мой мощности электродвигателя согласно выражению (8.25). Если принять / д*2=/ нт7> ч то близко к действительности, то
р |
2J ф |
+М |
д = — |
V — с . к |
Далее выбирают подходящий по мощности электродвигатель, обеспечи вающий наиболее компактную конструкцию электропривода.
Определение передаточного отношения ПУ целесообразно производить следующим графоаналитическим методом, который позволяет учесть воз можную нелинейность механических характеристик электродвигателя. В соответствии с уравнением (8.24) строится график зависимости максималь ного значения требуемого момента электродвигателя от передаточного от ношения ПУ (рис. 8.2,а — кривая Мд м(г)), далее проводится прямая, параллельная оси абсцисс и соответствующая номинальному значению мо
мента электродвигателя. Согласно условию (8.26), определяется диапазон возможных значений передаточного отношения редуктора i е [i\,i2]. П>а~ ничные значения ix и i2 находятся из уравнения (8.24) при Л/д м = А/д н:
М |
+ \ м 2 |
- 4 / ' ф |
|
(J |
ф |
+М |
с |
YFn |
|
= д . н |
д . н |
|
н . к v |
н*н . к |
|
" 1 |
(8.28) |
||
1 ,2 |
|
2J'<p |
|
|
|
|
|
||
|
н . к |
|
|
|
|
|
|||
|
|
|
JV |
|
|
|
|
|
Минимальное значение Л/Д.м min достигается при передаточном отноше нии
, |
- |
I |
м1
иопределяется следующим образом:
I |
J < р + М |
/ ' ÿ |
|
Мт |
н*н•к |
с |
|
.м min А1 |
Т) |
|
рТ у |
Из рис. 8.2,я следует, что если для минимального значения максималь ного динамического момента выполняется условие Мд м min > Мд н, то необ ходимо выбрать другой электродвигатель и повторить расчеты.
Затем определяется диапазон возможных значений передаточного отно шения, исходя из условия, определяемого выражением (8.27), обеспечения требуемого значения угловой скорости исполнительного органа и полезного груза. Поскольку максимальный требуемый момент электродвигателя за висит от передаточного отношения ПУ (рис. 8.2,а), при нежесткой механи ческой характеристике привода в выражении (8.27) необходимо учитывать, что фд р также зависит от передаточного отношения ПУ. Строится график зависимости фн к от i (рис. 8.2,а). Это прямая, параллельная оси абсцисс. Далее строится график зависимости требуемой скорости исполнительного органа фр(0 от передаточного отношения ПУ. С этой целью для различных значений i е ,*2] по графику Мд м (0 определяют соответствующие мак-
Рис. 8.2. Выбор передаточного отношения редуктора при контурном режиме работы ПР: а — определение диапазона возможных значений /; б — механическая характеристика электродвигателя
Мд м=Мд м*. Для этого значения момента по механической характеристике электродвигателя (рис. 8.2, б)находят соответствующие значения его ско-
Р°сти<Рд.р*-
Производя деление полученных значений скорости на соответствующие значения /, подсчитывают требуемую скорость исполнительного органа (для i = и ÿ>p* = ^>др* /0 , на основании которой строят зависимость Фр(0. Согласно условию (8.27), по графику <рр (0 определяют верхнюю границу диапазона передаточных отношений (/=23 на рис. 8.2,а).
Для случая одновременного выполнения соотношений (8.26) и (8.27) находят диапазон возможных значений i (на рис. 8.2 i е [г’| ,/3], из которого выбирают конкретное значение L Чтобы двигатель обладал наименьшим моментом, необходимо соблюдение условия i = iM. Если таких значений i не существует, следует.взять другой двигатель и повторить расчеты.
В приведенном расчете не используется возможность перегрузки элект родвигателя по моменту. Если это допускается, в выражения (8.26), (8.28) следует вместо Мд нподставлять ^ мМд н, где Ам— коэффициент перегрузки электродвигателя по моменту, а мощность электродвигателя вычислять по формуле
Последним этапом рассматриваемого энергетического расчета электро привода как при контурном, так и при позиционном режимах работы про мышленного робота является проверка электродвигателя на нагрев.
Электродвигатели будут работать не перегреваясь при циклическом ре жиме работы промышленного робота, если эквивалентное требуемое сред неквадратическое значение момента двигателя Мэ за период рабочего цикла *ц не превышает значения номинального момента двигателя Мэ:
(8.29)
ц
где Мдit) — текущее значение требуемого момента электродвигателя. Как следует из выражения (8.29), при проверке электродвигателя на
нагрев необходимо учитывать закон изменения его момента в течение всего периода рабочего цикла, что на начальных этапах проектирования доволь но затруднительно. Поэтому проверку целесообразно проводить на этапе моделирования и макетирования промышленного робота.
8.9. Общие вопросы синтеза следящих электроприводов промышленных роботов
Многокоординатная система следящего привода робота является много связной системой управления с переменными массой и моментом инерции
исполнительного органа, содержит, как правило, несколько нелинейностей (ограничение и зона нечувствительности в усилительных элементах, люфт и сухое трение в передаточных механизмах, нелинейности в системе “уси литель мощности —двигатель” и т.д.). Всвязи с этим точный теоретический анализ устойчивости и качества процесса позиционирования существенно затруднен. Целесообразно разделить задачу анализа и синтеза реальной системы привода на более простые задачи, обосновывая правомерность упрощения математической модели.
На начальных этапах проектирования следящий электропривод (СЭП) рассматривают автономно и в линейной постановке, допустимость чего обосновывается следующими соображениями.
Номинальный момент двигателя превышает в несколько раз момент трения в передаточном устройстве; влиянием последнего можно пренебречь за исключением случаев, при которых обеспечиваются перемещения рабо чего органа с малыми скоростями. Люфт механических передач обычно выбирается.
При разработке силовых преобразователей стремятся получить харак теристики системы “силовой преобразователь — электродвигатель”, близ кие к линейным. Нелинейность типа “зона нечувствительности” можно не принимать во внимание, так как она обычно повышает устойчивость систе мы.
В области выхода исполнительного органа манипулятора в заданную точку позиционирования нелинейности типа “ограничение” в достаточной степени себя не проявляют. Кроме того, можно считать неизменным приве денный к валу электродвигателя момент инерции исполнительного органа (скорость протекания переходных процессов в приводе обычно значительно превышает скорость изменения данного момента инерции). Расчет прово дится для наиболее “тяжелого” с точки зрения устойчивости случая.
С учетом принятых допущений рассмотрим построенный по типовой схеме следящий электропривод поворотной координаты робота с электро двигателем постоянного тока и управление от тиристорного или транзи сторного преобразователя. На рис. 8.3 представлена структурная схема такого электропривода, где kp w кр с, ктп, £д т, £д с , кд п — коэффициенты передачи (усиления) соответствующих элементов, первые три коэффици ента безразмерные, единицы измерения последующих трех соответственно В/A, В*с/рад, В/рад; Ля,£я — активное сопротивление и индуктивность якорной цепи электродвигателя и тиристорного (транзисторного) преобра зователя, Ом, Гн; к*м— коэффициент,определяющий зависимость момента на валу электродвигателя от тока якоря /я; кф — коэффициент обратной связи, определяющий зависимость противоЭДС от скорости вращения вала электродвигателя, В -с/рад;/ —приведенный к валу электродвигателя сум марный момент инерции ротора электродвигателя и нагрузки, кгм2; М*с — приведенный к валу электродвигателя статический момент, Н*м; Ттп —
Рис. 8.3. Структурная схема линеаризованного следящего привода: / — регулятор положе ния; 2 — регулятор скорости; 3 — тиристорный или транзисторный преобразователь; 4 — электродвигатель постоянного тока с нагрузкой; 3 — редуктор; 6 — датчик тока; 7 — датчик скорости (тахогенератор) ; 8 — датчик положения
постоянное время тиристорного (транзисторного) преобразователя, с; т — постоянная времени изодромного звена, с (предполагается, что регулятор скорости выполнен по схеме ПИ-регулятора).
Отсюда передаточная функция регулятора скорости
..кп |
_ |
к п (1+тр) |
V c (р)= * + - V |
= |
--------- |
где к — коэффициент усиления: к = £р ст; р — оператор изображения по Лапласу.
Структурная схема электропривода (рис. 8.3) учитывает изменение на
пряжения якорной цепи электродвигателя (£/я), момента (Л/д), скорости
dv д
вращения ротора под действием нагрузки / ( ----- ) согласно зависимостям:
ai |
% |
dt |
|
U*= ^ я ^ я + ^ я |
*■кфФ'-i |
|
|
dt |
|
|
|
dip |
Я = |
К ■ |
|
H T |
|||
V |
|||
|
|
После несложных преобразований структурную схему, изображенную на рис.8.3, можно привести к виду, показанному на рис. 8.4. Из этой схемы следует, что корректирующая обратная связь по току, представленная зве ном с передаточной функцией гр 2 (где —коэффициент усиления разомк нутого внутреннего контура связи по ускорению, с) может рассматриваться как обратная связь по ускорению электродвигателя. На данной схеме W(p)— передаточная функция разомкнутого скорректированного следя щего электропривода; А(р) —оператор преобразования, определяемый из выражения
А(р) = (1+7,т.пр)(1+7,мр + 7,м7,эр2)э |
(8.30) |
Рис. 8.4. Преобразованная структурная схема следящего электропривода
где TM^ J R j ( k M9k^) — электромеханическая постоянная времени привода при воздействии нагрузки, с; Тэ= Ья/К я— электрическая постоянная вре мени якорной цепи электродвигателя, с.
Коэффициент усиления разомкнутого следящего электропривода (с-2)
= ^ д . п ^ р . п ^ р . с ^ т . п |
(8.31) |
к - i
1р коэффициент усиления разомкнутого внутреннего контура связи по скоро сти
к |
к |
к |
(8.32) |
V = — Д-с |
|
Р - с т -п |
|
|
|
к - |
|
коэффициент усиления разомкнутого внутреннего контура связи по уско рению (с)
Г = * д т * т . г / |
(8.33) |
оператор |
|
7^ РК1+Тэр )(1+ Т т пр)+ |
|
С(р) |
(8.34) |
Л |
1 + т р |
При выбранной структуре следящего электропривода синтез сводится к определению оптимальных значений ji,u, г, т исходя из параметров внут ренних контуров и всего следящего электропривода. Настройка следящего электропривода осуществляется по каждому контуру в отдельности. Поэ тому необходимо найти связь между полученным в результате синтеза коэффициентом г и коэффициентом усиления г' разомкнутого внутреннего контура связи по току. Согласно рис. 8.3,
. ^ д . т ^ т . п
или
* д . т * т . |
м <р |
к' к -
М i f
Отсюда с учетом (8.30) и (8.33) получаем г' = г / Т м .
Передаточная функция разомкнутого по цепи главной обратной связи и скорректированного следящего электропривода в соответствии с рис. 8.4
имеет вид |
|
p i 1+тр) |
(8.35) |
Wi p) ----------------------- -------------- 5 -. |
|
p [ p A i p ) + v i 1+тр)+грг J |
|
Поскольку порядок астатизма следящего привода определяется числом полюсов передаточной функции разомкнутого скорректированного следя щего привода, из выражения (8.35) следует, что следящий электропривод имеет первый порядок астатизма.
Ошибка работы следящего электропривода определяется из следующих
двух уравнений (рис. 8.4): |
|
|
|
||
(pip) = |
W( p) ô( p) - C( p) W( p) Mlc (p )#, |
|
|||
8ip)=<P3ip) - ( pi p), |
|
|
|
||
откуда изображение ошибки |
Cip)Wjp) |
|
|||
<5 (р) = |
1 |
(P3ip) |
+ |
< < р > ' |
|
|
1+ИЧр) |
|
1+ИЧр) |
Первое слагаемое определяет ошибку 6 , вызванную управляющим воз действием (р3, второе — моментную ошибку ô M. Воспользовавшись теоре мой о предельном значении оригинала, найдем установившиеся ошибки следящего электропривода при действии типовых управляющих и возму щающего воздействий. При этом линейное представление следящего элек тропривода позволяет воспользоваться принципом суперпозиции. Предположим, что Мс*= 0. При ступенчатом управляющем воздействии 6^=0, так как следящий электропривод имеет первый порядок астатизма.
При движении с постоянной скоростью фп с установившаяся скоростная
ошибка |
|
|
|
|
|
Ô C K |
=limô c v i t ) |
= 1 i ш |
p ô ( p ) = lim |
p |
-------- |
ск |
t+oo с K |
p->oo |
^ 9 и p-wo |
F |
\+Wip) |
_ v |
<PП . c |
|
|
|
(8.36) |
|
|
|
|
||
При гармоническом законе движения (p3it) |
= (pasinu)yt с амплитудой |
колебаний #>а(рад) и круговой частотой Wyte’1) амплитудное ô a значение ошибки определяется по следующему выражению:
1 |
(8.37) |
|
1 +ИЧ/«у > Va ~ |
||
|IK</W ) I |
При <рз“ 0 и м ‘с = const имеем
ô M = 1 im pôM(p) |
= 1i m |
C{p)W ( p) Mf c |
(8.38) |
||
P -► C O |
p->00 |
1 + W(p)p |
Отсюда с учетом (8.34) и (8.35) получаем ô M=0. Из анализа выражений (8.34), (8.35) и (8.38) следует, что нулевая статическая ошибка обеспечи вается за счет введения в контур регулирования скорости ПИ-регулятора.
Для удобства синтеза целесообразно получить несколько измененные выражения для оценки ôCKи <5а . Зная желаемые логарифмические ампли тудно-частотные характеристики (ЛАЧХ) разомкнутого скорректирован ного следящего электропривода (на рис.8.5,л цифры 1, 2, 3..., означают наклоны асимптот желаемой ЛАЧХ, начиная с первой низкочастотной, соответственно на -20дцБ/дск, -40дцБ/дек...), можно считать (для обрат ных ЛАЧХ L\ И^-1^ ) |), что в области частот, определяющих точность следящего электропривода,
W(ja>)=. ^
jü)
где о>Ср— частота среза следящего электропривода, соответствующая усло вию L\ W{jb)) | =1 .
Тогда
W ( р ) = wcp/ p .
Подставляя эти выражения в (8.36) и (8.37), получаем
б |
|
= Ф |
|
/и) |
; |
б |
|
= |
и . , |
ф |
|
|
ск |
. с |
a |
,. |
|
(8.39) |
|||||||
|
|
|
с р ’ |
|
|
ü) |
с р |
^• ая |
||||
|
|
|
|
|
^ |
|
|
|
|
|
|
Рассматриваемые ошибки являются лишь частями общей ошибки следя щего электропривода. Это необходимо учитывать при задании их допусти мых значений.
|
з Ж |
! |
< Ы 1 |
e |
|
|
|
4 0
|(?
; и г ^ /о с
L
-*0 1 ^ \ ' l z ,
A ù ’o j h
шÎ+T jcdjl
i |
|
щ |
|
|
IЪ i Ttn |
0,1 |
|
paâ/c WuOh |
|||
|
\ |
iагд |
|
M
I*
-МОГ
__ (jui?A(ju) lJ&Jj__^
arff^r'Ju |
|
1 ÙJ__». 10 |
!ùVpod/cmO |
% , argWBt(ju))
1
Рис. 8.5. Логарифмические частотные характеристики следящего электропривода:
а — логарифмические амплитудно-частотные; б — логарифмические фазспо-частотные