CC BY
96
Наука к Образование
МГТУ им. Н.Э. Баумана
Сетевое научное издание
ISSN 1994-0408 УДК 621. 313. 323
Способ определения закона управления разомкнутым шаговым электроприводом
профессор, д.т.н. Красовский А. Б. ' kra 50У skv igbmstuju
1МГТУ им. Н.Э. Баумана, Москва, Россия
Рассматривается разомкнутый шаговый электропривод с электрическим дроблением шага и питанием двигателя от управляемого инвертора тока, к которому предъявляется требование отработки заданной траектории движения произвольной формы с высокой точностью. Показано, что при традиционном программном управлении, когда фазные токи двигателя формируют одинаковой амплитуды и переменной частоты пропорциональной заданной программной скорости движения, из-за невозможности гибкого воздействия на динамический момент двигателя возможны значительные ошибки. Предложен и обоснован новый способ определения алгоритма управления, адекватного параметрам привода и программируемой траектории движения, обеспечивающий минимизацию ошибки регулирования и повышение за счет этого точности отработки заданных параметров движения и расширяющий динамические возможности привода. Суть предлагаемого способа состоит в использовании видоизмененной математической модели привода в d и q координатах, в которой в качестве входного воздействия выбирается программируемая траектория движения, а необходимый закон управления находится из решения соответствующих уравнений. Разработана имитационная модель электропривода в среде MATLAB - SIMULINK, с помощью которой на типовых примерах проверена эффективность предложенного способа определения закона управления.
Ключевые слова: шаговый двигатель, динамическая ошибка, управляемый инвертор тока, заданная тахограмма движения, повышение быстродействия и точности, имитационное моделированж
Введение и постановка задачи
Разомкнутые структуры шаговых электроприводов (ШЭП) на базе двигателей синхронного типа широко используются в различных устройствах точного воспроизведения заданных параметров движения, например, в роботах, станках с числовым программным управлением, сборочном оборудовании и т.п. [1-4]. Работа ШЭП состоит в суммировании элементарных шагов ротора двигателя, поэтому присущая ему способность квантования движения и запоминания конечных координат перемещения при ограничении средствами управления статических и динамических ошибок на допустимом уровне во многих случаях позволяет реализовывать программные перемещения без позиционных и скоростных обратных связей.
Наука и Образование. МГТУ им. Н.Э. Баумана. Электрон. журн. 2015. № 03. С. 320-330.
DOI: 10.7463/0315.0761902
Представлена в редакцию: 24.03.2015
© МГТУ им. Н.Э. Баумана
Для расширения частотного диапазона работы привода, повышения точности позиционирования и устойчивости движения в ШЭП за прошедшие годы разработаны различные варианты электрического дробления шага двигателя, которые не зависимости от конкретной технической реализации сводятся к увеличению числа промежуточных электрических состояний двигателя и, соответственно, промежуточных устойчивых положений ротора двигателя внутри его основного конструктивного шага перемещения за счет уменьшения угловой дискретности смещения кривой синхронизирующего момента при поступлении каждой команды на перемещение [3].
В настоящее время при использовании цифроаналоговых преобразователей необходимой разрядности и ШИМ - преобразователей напряжения в сочетании с локальной токовой обратной связью и предварительной калибровкой двигателя практически отпали ограничения на его минимальный шаг перемещения ротора за счет возможности формирования синус-косинусных или близких к ним по форме кривых фазных токов. [3] Это с физической точки зрения практически полностью стирает грань между традиционным ШЭП и классическим частотно управляемым синхронным электроприводом непрерывного типа[5].
При традиционном разомкнутом программном управлении ШЭП с помощью управляемого инвертора тока обычно формируют фазные токи двигателя одинаковой амплитуды 1т и переменной частоты, пропорциональной заданной программной скорости движения шзад(0 [6,7,8]. В частности, применительно к идеализированной двухфазной модели двигателя фазные токи должны изменяться согласно выражениям
где у(7) мгновенное значение угла в функции времени определяющего пространственное положение результирующего вектора тока статора двигателя, рассматриваемого в данном случае как управляющее воздействие. Законы изменения программной скорости шзад(0 и угла у^) обычно связаны соотношением
При таком управлении из-за электромагнитной и механической инерционности и отсутствия непосредственной возможности формирования необходимого закона изменения динамического момента двигателя реальная траектория движения может значительно отличаться от программируемой траектории. В подтверждение сказанного на рисунке 1 показан пример программируемой тахограммы движения юзад(0 трапециидальной формы и получаемая при этом реальная тахограмма движения ш(^) привода с типовыми параметрами. Там же показан закон изменения управляющего воздействия у(7), определенный по выражению (2).
Как видно, на начальном этапе разгона развиваемое двигателем ускорение б(^) оказывается меньше заданного значения Бзад(0, а затем возникает колебательный процесс его изменения, при котором лишь среднее значение реального ускорения в(^) совпадает с ускорением Бзад(0, соответствующим программируемому закону изменения скорости
(1)
КО = /<Озад(0^
(2)
юзад(Х). В результате реализуемая приводом тахограмма движения ш(^) имеет значительную колебательную составляющую, которая в данном случае представляет собой ошибку регулирования, ограничивающую точность воспроизведения заданных параметров движения привода и, кроме того, её наличие ограничивает максимальные значения динамического момента и ускорения подвижных частей привода из-за опасности выпадения двигателя из синхронизма.
Исходя из сказанного выше можно заключить, что при отработке заданной траектории движения алгоритм определения закона изменения управляющего воздействия у^) на основании выражения (2) требует корректировки, т.е. в выражении для у^) должна присутствовать дополнительная переменная составляющая Ду, изменяемая по определенному закону в зависимости от вида программируемой траектории движения и параметров привода для корректировки закона изменения динамического момента ШЭП и снижения за счет этого ошибки регулирования, т.е.
КО = / + ДК^зад(О) (3)
Целью данной статьи является обоснование и разработка скорректированного метода определения закона изменения управляющего воздействия у^) разомкнутого ШЭП, адекватного параметрам привода и программируемой траектории движения, обеспечивающего минимизацию ошибки регулирования и повышение за счет этого точности отработки заданных параметров движения и расширяющего динамические возможности привода.
1 I I 1 1 1
у../),.-—
/ У 1 У* У V у
( У У у со( Г)
//— /" у Ч уу* у Хч
А' ) N
1
.2|_I_I_I_I_I_I_I_
О 5 10 15 20 25 30 35 40
ПтеоГМ: О
Рисунок.1. Заданная юзад(/), реальная ю(/) тахограммы движения и закон изменения углового положения
результирующего вектора тока двигателя у(/).
Предлагаемый подход к достижению поставленной цели
В теории ШЭП доказано, что при определенных допущениях и ограничениях на параметры привода для описания его статических и динамических характеристик применимы обобщенные уравнения двухфазной модели привода в координатах [2,3], которые в относительных единицах при общепринятых базовых величинах для случая питания двигателя от источника напряжения имеют вид
did . dQ ,
Ч + Х~т-- Xlq ~r: = cos(y - 0)
di
d&
d&
iq+X^ + Xid— = sin (y - 0) - <5 —
dr
d2e _ .
+ Me - Iq
dr
(4)
где id, iq - составляющие результирующего вектора тока статора двигателя в долях тока короткого замыкания фазы по ортогональным осям d и q, соответственно; х -электромагнитная постоянная времени фазы в долях периода круговых колебаний привода; S - относительная ЭДС движения при скорости, равной круговой частоте колебаний привода; - относительное значение момента сопротивления нагрузки в долях амплитуды синхронизирующего момента двигателя; т - относительное время, измеренное в долях периода круговых колебаний привода.
При питании фазных обмоток двигателя от источника тока и формировании фазных токов синус-косинусной формы составляющие результирующего вектора тока статора по осям d и q могут быть определены как
id = eos (у - 0)] iq = sin (У-®);
При подстановке выражений для токов id, iq из (5) в уравнения (4) получаем математическое описание динамики ШЭП в d,q координатах при питании двигателя от источника тока [9]
dy
(5)
ud = cos(y - 0) - / — sin(y - 0) uq = sin(y — 0) +Z^cos(y-0) +ô^
d20
Ir
(6)
Суть предлагаемого подхода к определению закона изменения управляющего воздействия у(/), адекватного заданной траектории движения и параметрам привода состоит в том, что для этой цели используется математическая модель привода в й и q координатах, построенная по уравнениям (6), причем в модели ШЭП в качестве входного
воздействия выбирается программируемая или желаемая траектория движения 0(т) или
dQ(т) , л „
^ = ^Зад(т), а соответствующий этой траектории движения закон изменения
управляющего воздействия у^) находится из решения этих уравнений, как это условно показано на функциональной схеме на рисунке 2.
Рисунок 2. Функциональная схема алгоритма определения управляющего воздействия.
Описание модели и результаты моделирования
Схема имитационной модели для определения необходимого закона управления шаговым электроприводом, построенной в среде MATLAB - SIMULINK [10] по уравнениям (6), показана на рисунке 3. Желаемая траектория движения, т.е. зависимость <озад(т) формируется в субсистеме Generator Traektorii с применением стандартных блоков SIMULINK и здесь не раскрывается, т.к. её реализация будет разной в зависимости от вида функции о>3 ад (т) . Блок Integrator рассчитывает текущее угловое положение ротора двигателя 0 (т) . Блок Trigonometric Function реализует математическую операцию arcsin, в результате чего вычисляет динамическую ошибку (у — 0 ) по текущему значению момента двигателя, определяемого на выходе блока Add. На выходе блока Add1 рассчитывается искомый скорректированный закон изменения управляющего воздействия y(z), который посредством блока To File передается в файл с именем gamma и может быть запомнен для последующего использования.
Рисунок 3 - Имитационная модель ШЭП для определения закона управления у(/).
Одновременно с этим, модель позволяет рассчитывать составляющие вектора результирующего напряжения фаз двигателя иа и ичпо осям й и q, соответственно, и амплитуды результирующего вектора напряжения и2, которая может быть использована для оценки требуемого минимального запаса по напряжению силового источника питания при отработке заданной траектории движения. Эффективность предлагаемого способа определения закона управления проиллюстрируем на двух примерах программирования и отработки ШЭП типовых траекторий движения.
Первый пример соответствует рисунку 1, т.е. рассматривается задача реализации тахограммы движения юзад(г) трапециидальной формы. Скорректированный закон изменения управляющего воздействия у(г), соответствующий такой тахограмме движения ®зад(г), показан на рисунке 4. Заметим, что характер изменения мгновенного положения ротора двигателя ©(г)
0(т) = / ш (т)йт (7)
при скорректированном законе управления повторяет закон изменения управляющего воздействия у(г) на рисунке 1, вычисляемого по формуле (1). Это объясняется тем, что при скорректированном законе управления у(г) реальная тахограмма движения ш(г), и программируемая шзад(г), совпадают, т.е. о(г) = юзад(г).
Как видно, моделирование показывает, что изломам в программируемой тахограмме движения для её отработки без ошибки должны соответствовать определенные мгновенные приращения или уменьшения угла у(г) на некоторую переменную величину Лу(шзад(т)), что эквивалентно мгновенным положительным или отрицательным сдвигам фазы синус - косинусных зависимостей токов, формируемых в обмотках двигателя.
................... 1 ........................1......................... ®(т) !
Уч(х).,.
/ / .А X у
у' У^ у / > х .........^.............. у х У ^г у х X .Х^ М*)
\ \ \
У -—— ¿г
✓ /___- \ \ \ \ 1 V 1
Рисунок.4. Заданная тахограмма движения юзад(г) трапециидальной формы и соответствующие ей скорректированный закон управления у(г), изменение положения ротора ©(г) и амплитуды результирующего вектора напряжения и2 (т).
Теоретическое обоснование возможности отсутствия ошибки регулирования при таком управлении состоит в том, что при надлежащем (в данном случае мгновенном) изменении угла у(т) при отработке рассматриваемой заданной траектории движения на любом её участке может задается динамический момент привода необходимого значения
«^задСО
и знака, соответствующий программируемому ускорению —— на том или ином участке траектории движения. Важно также отметить, что, как видно из рисунка 4, изломам в кривой шзад(т) соответствуют разрывы в кривой результирующего напряжения и^(т). Это свидетельствует о том, что тахограмма движения шзад(т) строго трапециидальной формы может быть отработана ШЭП только при бесконечно больших форсировках напряжения силового источника питания, что технически нереализуемо.
Во втором примере приведем результаты моделирования, соответствующие отработке приводом тахограммы движения шзад(т) с плавным изменением ускорения
——. В частности, для определенности, в этом примере участок тахограммы шзад(т) с
увеличением скорости принят состоящим из трех этапов (см. рисунок 5). Эти этапы помечены на рисунке 5 цифрами 1,2,3, причем на этапе 2 предполагается линейное её изменение, а на 1 и 3 этапах - по квадратичным законам в функции относительного времени т. С целью упрощения, не изменяющего суть предлагаемого решения также принято, что участок траектории шзад(т), соответствующий торможению привода (с
отрицательным ускорением ——), аналогичен по форме участку увеличения скорости,
т.е. кривая юзад(т) симметрична относительно вертикальной оси, проходящей через её середину.
1 1 2 3 0(т)
Л у
СОзадС
/ ./ у .у / У / __ Щ \ (X)
/ \ \ \
\ V.
Рисунок.5. Заданная кривая тахограммы движения юзад(г) с плавным изменением ускорения ^^ад(т)и
соответствующие ей скорректированный закон управления у(т), изменение положения ротора ©(т) и амплитуды результирующего вектора напряжения щ( т).
Найденный в результате моделирования характер изменения управляющего воздействия у(т), необходимый для отработки рассматриваемой траектории движения, показан на рисунке 5 штрихпунктирной линией. Видно, что при отсутствии
скачкообразного изменения программируемого ускорения , скачкообразные сдвиги
фазы в кривой у(т) также отсутствуют, однако по-прежнему, каждому характерному участку в кривой шзад(т) соответствует строго соответствующий ему закон непрерывного изменения управляющего воздействия у(т). При этом рассчитанная на модели кривая изменения напряжения и2(т) не содержит разрывов, что свидетельствует о технической реализуемости рассматриваемой траектории движения привода юзад(т). Необходимое условие для этого - наличие необходимого запаса по напряжению силового источника питания, при котором обеспечивается требуемый закон изменения напряжения и2(т) на всех участках траектории шзад(т).
Выводы
1. Показано, что при традиционном программном управлении разомкнутым шаговым электроприводом с электрическим дроблением шага из-за невозможности гибко воздействовать на динамический момент привода могут появляться значительные ошибки, ограничивающие точность отработки заданной траектории, динамические показатели привода и провоцирующие при определенных условиях колебательные процессы и даже выпадение двигателя из синхронизма;
2 Теоретически обосновано, что для гибкого управления динамическим моментом привода и повышения за счет этого точности воспроизведении заданной траектории движения закон изменения углового положения результирующего вектора тока статора двигателя целесообразно определять на математической модели привода, причем в качестве входного воздействия нужно выбирать программируемую или желаемую траекторию движения, а соответствующий этой траектории закон управления находить в результате моделирования;
3. Разработана имитационная модель ШЭП в среде МАТЬАВ - ЗГМиЬШК в координатах при питании двигателя от управляемого источника тока, с использованием которой на двух типовых примерах проверена эффективность предложенного способа определения закона управления, адекватного параметрам привода и заданной программируемой траектории движения;
4. Установлено, что отработка без ошибки заданной траектории движения в виде тахограммы юзад(т) при наличии в ней изломов технически не реализуема, поскольку требует бесконечно больших форсировок напряжения силового источника питания для обеспечения мгновенных положительных или отрицательных сдвигов фазы токов, формируемых в обмотках двигателя.
Список литературы
1. Acarnley P. Stepping motors. A guide to theory and practice. 4th ed. London: Institution of Engineering and Technology, 2007. 159 p.
2. Чиликин М.Г., Ивоботенко И.А., Рубцов В.П., Садовский Л.А., Цаценкин В.К. Дискретный электропривод с шаговыми двигателями / под общ. ред. М.Г. Чиликина. М.: Энергия, 1971. 624 с.
3. Ивоботенко Б.А., Козаченко В.Ф. Шаговый электропривод в робототехнике. М.: МЭИ, 1984. 101 с.
4. Stephen J. Chapman Electric Machinery Fundamentals. McGraw-Hill Companies, 2003. 746 p.
5. Ситников А.В. Синтез системы управления шаговым двигателем // Инженерный вестник. МГТУ им. Н.Э. Баумана. Электрон. журн. 2014. № 10. Режим доступа: http://engbul.bmstu.ru/doc/738896.html (дата обращения 01.02.2015).
6. Firoozian R. Servo Motors and Industrial Control Theory. Springer US, 2009. 229 p. DOI: 10.1007/978-0-387-85460-1
7. Ситников А.В., Ажгиревич И.Л., Пущин А.В. Стенд для управления шаговым двигателем // Инженерный вестник. МГТУ им. Н.Э. Баумана. Электрон. журн. 2014. № 5. Режим доступа: http://engbul.bmstu.ru/doc/709836.html (дата обращения 01.02.2015).
8. Harprit Singh Sandhu. Running Small Motors With PIC Microcontrollers.The McGraw-Hill Companies, 2009. 334 p.
9. Красовский А.Б. Разработка высокочастотного модульного электропривода гибких автоматизированных производств с управляемыми инверторами тока: автореф. дис. ... канд. техн. наук. М., МЭИ, 1985. 20 с.
10. Красовский А.Б. Применение имитационного моделирования для исследования вентильно-индукторного электропривода // Электричество. 2003. № 3. С. 35-45.
Science and Education of the Bauman MSTU, 2015, no. 03, pp. 320-330.
DOI: 10.7463/0315.0761902
Received:
24.03.2015
Science^Education
of the Bauman MSTU
ISS N 1994-0408 © Bauman Moscow State Technical Unversity
A Control Law Definition of the Open Loop Stepping Electric Drive
A.B. Krasovskii1*
kra 50 vsky igbmstuju bauman Moscow State Technical University, Moscow, Russia
Keywords: stepping motor, dynamic error, controlled invertor of a current, the set trajectory of
movement, accuracy increase, simulation
The paper considers an open loop stepping electric drive (SEP) with electric crushing of a step and motor fed from the controlled current invertor which should meet the requirement that is to trial a free-form guided trajectory with a split-hair accuracy. It is shown that with traditional programmed control, when the SEP forms motor phase currents of identical amplitude and variable frequency proportional to the set speed of movement, there may be considerable errors reducing a trial accuracy of the set movement trajectory, dynamic indicators provoking oscillatory processes, and even loss of motor synchronism because influence on a dynamic moment of the motor is impossible.
The paper offers and proves a new way to define a control algorithm adequate to drive parameters and programmed trajectory of movement, providing error minimization and thereby increasing trial accuracy of set parameters of movement and expanding dynamic capabilities of a drive. The essence of the offered way is to use a modified mathematical model of a drive in d,q coordinates with a motor fed by the current source. In this model a programmed trajectory of movement is chosen as an input action while solving the appropriate equations defines the necessary law of control. The paper describes a developed simulation model of the stepping electric drive in the environment of MATLAB - SIMULINK, which has been used to verify and prove an efficiency of the offered method to define a control law via typical examples.
It is established that no error trial of set movement trajectory in case it has breaks (jogs) is technically unfeasible, as it demands an infinitely high forcing voltage of the power supply to maintain the instant positive or negative phase shifts of currents formed in the motor windings.
The obtained results can be used in designing programmable precision SEPs in robots, numerically controlled machine tools, and assembly equipment.
References
1. Acarnley P. Stepping motors. A guide to theory and practice. 4th ed. Published by the Institution of Engineering and Technology, London, 2007. 159 p.
2. Chilikin M.G., Ivobotenko I.A., Rubtsov V.P., Sadovskii L.A., Tsatsenkin V.K. Diskretnyi elektroprivod s shagovymi dvigatelyami [Discrete electric drive with stepper motors]. Moscow, Energiya Publ., 1971. 624 p. (in Russian).
3. Ivobotenko B.A., Kozachenko V.F. Shagovyi elektroprivod v robototekhnike [Stepper drive in robotics]. Moscow, MPEI Publ., 1984. 101 p. (in Russian).
4. Stephen J. Chapman Electric Machinery Fundamentals. McGraw-Hill Companies, 2003. 746 p.
5. Sitnikov A.V. Synthesis of stepper motor control system. Inzhenernyi vestnikMGTU im. N.E. Baumana = Engineering Herald of the Bauman MSTU, 2014, no. 10. Available at: http://engbul.bmstu.ru/doc/738896.html , accessed 01.02.2015. (in Russian).
6. Firoozian R. Servo Motors and Industrial Control Theory. Springer US, 2009. 229 p. DOI: 10.1007/978-0-387-85460-1
7. Sitnikov A.V., Azhgirevich I.L., Pushchin A.V. Stand for stepper motor control. Inzhenernyi vestnik MGTU im. N.E. Baumana = Engineering Herald of the Bauman MSTU, 2014, no. 5. Available at: http://engbul.bmstu.ru/doc/709836.html , accessed 01.02.2015. (in Russian).
8. Harprit Singh Sandhu. Running Small Motors with PIC Microcontrollers. McGraw-Hill Companies, 2009. 334 p.
9. Krasovskii A.B. Razrabotka vysokochastotnogo modul'nogo elektroprivoda gibkikh avtomatizirovannykh proizvodstv s upravlyaemymi invertorami toka. Avtoref. kand. diss. [Development of high-frequency modular electric drive of flexible automated production with controllable inverters of electric current. Abstract of cand. diss.]. Moscow, MPEI, 1985. 20 p. (in Russian).
10. Krasovskii A.B. The use of simulation to investigate a switched-reluctance electric drive. Elektrichestvo = Electricity, 2003, no. 3, pp. 35-45. (in Russian).
