Синтез алгоритмов управления шаговыми приводами 3D-принтера по осуществлению предписанных движений

БАТЫРКАНОВ Ж. И., КАДЫРКУЛОВА К. К., БЕЛЯЛОВ Ш. А.

СИНТЕЗ АЛГОРИТМОВ УПРАВЛЕНИЯ ШАГОВЫМИ ПРИВОДАМИ 3D-ПРИНТЕРА ПО ОСУЩЕСТВЛЕНИЮ ПРЕДПИСАННЫХ ДВИЖЕНИЙ Аннотация. Предложена оригинальная математическая модель шагового привода как объекта управления, на основе которой определяется алгоритм управления шаговым двигателем. Рассмотрены вопросы технической реализации синтезированных алгоритмов управлений, приведена структурно-функциональная схема для рассматриваемых функциональных элементов. Также рассматриваются вопросы погрешности позиционирования шагового двигателя и выбора его угловой скорости.

Ключевые слова: 3D-принтер, шаговый двигатель, шаговый привод, предписанная пространственная траектория, управление движением, единичный шаг, драйвер, число фаз.

BATYRKANOV ZH. I., KADYRKULOVA K. K., BELIALOV SH. A.

SYNTHESIS OF CONTROL ALGORITHMS FOR 3D-PRINTER STEP DRIVES

FOR IMPLEMENTATION OF PRESCRIBED MOVEMENTS Abstract. The paper presents an original mathematical model of the step drive as a control object. Based on this model, the control algorithm for the stepper motor is determined. The issues of technical implementation of the synthesized algorithms are considered. The structural-functional scheme for the considered functional elements is provided. The authors also deal with the error positioning of the stepper motor and the choice of its angular velocity.

Keywords: 3D-printer, stepper motor, stepper drive, prescribed spatial trajectory, movement control, single step, driver, number of phases.

Введение. При проектировании и разработке 3D-принтера важное место занимают вопросы разработки систем управления приводами его рабочих органов. На сегодняшний день в качестве приводов многих типов 3D-принтеров используются приводы, построенные на шаговых двигателях (ШД). В конечном итоге система управления должна обеспечивать движение рабочих органов 3D-принтера по заранее заданным предписанным траекторным движениям. Для синтеза необходимых алгоритмов управления движения приводов по предписанным программам (траекториям), в первую очередь, требуется наличие математической модели динамики шагового привода как объекта управления. Насколько нам

известно, в описании промышленно выпускаемых ЗБ-принтеров информации о математической модели не приводится.

В связи с вышесказанным, целью данной работы является следующее: для ЗБ-принтера, использующего метод послойного наплавления (см. рис. 1), разработать метод синтеза алгоритмов управления по осуществлению движения шаговых приводов по предписанным программам.

Рис. 1. Упрощенная модель ЗБ-принтера, использующего метод послойного наплавления.

Разработка математической модели динамики ШД как объекта управления. Прежде всего, приведем базовую информацию о ШД. Для всех типов ШД с помощью электронного коммутатора вырабатываются импульсы напряжения, которые подаются на обмотки управления, расположенные на статоре ШД. При этом каждый импульс обеспечивает поворот ротора на определенный угол, зависящий от конструкции ШД.

Для синтеза законов управления рассмотрим ШД с зубчатым передаточным механизмом на валу двигателя. При помощи этого механизма вращательное движение ротора двигателя преобразуется в поступательное движение механизмов 3Б-принтера (в конечном счете - его печатающей головки).

Пусть на роторном валу ШД посажено (установлено) зубчатое колесо (шестерня) с радиусом Я и угловым расстоянием между двумя зубьями Аа градусов, т.е. угол поворота ротора ШД при действии единичного импульса составляет Аа градусов. В дальнейшем требуется представить Аа в радианах. Перевод из градусов в радианы осуществляется по следующей формуле:

Аа\рад]= ЗД^МСА^]). ^

180\град]

При действии единичного импульса на ШД с посаженной на валу его ротора шестерней с радиусом Я, одиночный угловой шаг поворота ротора преобразуется в поступательное движение шестерни на расстояние равное

Ьш = Аа  Я,

где: А а — шаг поворота ротора ШД при подаче единичного импульса (градусы);

— величина линейного шага шестерни при действии одного импульса на ШД [1].

Так как в ШД шаги осуществляются в дискретные моменты времени, то математическая модель ШД как объекта управления описывается с использованием конечно-разностного выражения

где: р — текущее угловое положение ротора ШД на ^ -ом моменте времени;

пк — количество управляющих импульсов, подаваемых на ШД за отрезок времени [гк, гк+1 ];

Р*+1 — угловое положение ротора ШД в 4+1-й момент времени.

Формула (3) используется тогда, когда требуемые перемещения рабочих органов 3D-принтера описаны в угловых координатах. Однако в большинстве случаев необходимые перемещения описываются в линейных координатах, например, когда применяется винтовой редуктор. При этом, аналогично (3), предлагается следующая математическая модель управления движениями рабочих органов 3D-принтера [1]

X к+1 = ^ к + пкх1шх •

у = у + п I •

1 к+1 ^к^^ку1 шу->

Ъ к+1 = Ъ к + nkz^шz,

где: Хк, Ук, Ък — текущие координаты рабочих органов принтера по осям X, У, Ъ в ^й

момент времени; Xi+1, Ук+1, Ък+Х — координаты рабочих органов по осям X, У, Ъ в

момент времени; пкх, п^, пкг — количества импульсов поданных на ШД приводов по осям

X, У, Ъ за указанный промежуток времени; /шх, I , /Ш2 — величины линейных шагов рабочего

органа по осям X, У, Ъ от действия одиночных импульсов на соответствующие ШД, при этом учитываетсся соотношение (2).

Синтез алгоритма управления шаговым приводом на основе предписанной траектории. Рассмотрим задачу, когда рабочие органы 3D-принтера (печатающие головки) совершают движения согласно табличным представлениям контрольных точек в изготавливаемых изделиях.

Для осуществления этой задачи математическая модель динамики шагового привода

приведена в виде (4).

Таким образом, в практическом плане задача управления ШД сводится к нахождению количества управляющих импульсов пкх, пку, пкг из формул (4) и подаче их на соответствующие

ШД за отрезок времени , ]. При этом значения , Ък+Х берутся из таблицы

предписанных (требуемых) контрольных точек пространственной траектории движения рабочих органов ЗБ-принтера (таблица 1).

Проиллюстрируем построение предписанной пространственной траектории движения рабочих органов 3Б-принтера с помощью рисунка 2.

Рис. 2. Пространственная модель детали с нанесенными на нее контрольными точками.

По требуемой пространственной модели объекта с нанесенными на нее контрольными точками строим таблицу для предписанной траектории движения рабочего органа 3Б-принтера (см. табл. 1).

Таблица 1

Предписанные координаты в различных точках траектории

ч ¿2 ч 1к +1 *ь+!

х^ Х2 хк Хк+1 Х1 ХЬ+1

У* У1 У 2 Ук Ук+1 Уь Уь+1

2 2 2к 2к+1 2ь +1

Начало движения печатающей головки осуществляется с момента ^ и начального положения (Х1, ^, Z1) . Затем выполняется переход в положение (Х2, У2, ^ ), соответствующее моменту времени £2. Далее движение осуществляется аналогично, и в конце первого цикла, соответствующего первому слою воспроизводимого объекта, печатающая головка приходит в начальное положение, т.е. (Х1, Уг, ^). Из этого положения осуществляется переход в положение (Хм, Ум, Zлr) и затем движение осуществляется по второму слою объекта,

воспроизводимого 3D -принтером.

Далее движение выполняется по третьему слою и т.д. Таким образом, слои могут наноситься последовательно, т.е. друг на друга. В конце работы осуществляется переход к конечному положению (Хь, Уь, ^ ) .

Для определения /^, / , /^ в системе (4) нужна конкретная информация о шаговом

двигателе и соединенного с валом двигателя редукторе.

Взят ШД марки ДС4-6В и винтовой редуктор с длиной винта 74 мм и диаметром 3 мм. При этом экспериментально определено, что за одиночный импульс винтовой редуктор перемешает нагрузкой на 1,6 мм. Значит /^ = / = /^ = 1,6 мм.

Отметим, что подсчет количества необходимых импульсов по формулам

пк = (X к+1 -X к)/ 1ш

будет выражаться не целым числом. В этом случае берется ближайшее целое число (по стандартным правилам округления), а максимальная погрешность позиционирования ШД составит

б = 0,5/ .

шах ' ш

Следовательно, чтобы уменьшить погрешность позиционирования ШД нужно уменьшить /ш. А для этого, в свою очередь, нужно уменьшить величину единичного шага (поворота

ротора) Аа, которая достигается путем выбора ШД с необходимым количеством полюсов (в том числе, эквивалентных полюсов). Необходимая скорость движения ШД обеспечивается путем уменьшения или увеличения величины отрезка по времени , 1к+1 ] при фиксированных

количествах импульсов, которые должны быть поданы на ШД за этот отрезок. Уменьшение отрезка по времени увеличивает скорость движения (перемещения) ШД и, как следствие,

печатающей головки [2; 3].

Вопросы технической реализации системы управления шаговыми двигателями прототипа 3Б-принтера. Приведем технические реализации отдельных функциональных элементов прототипа ЗБ-принтера, которые разработаны авторами и используются на кафедре «Автоматического управления» КГТУ им. И. Раззакова для образовательных и исследовательских целей.

Для управления ШД используется компьютер (ПЭВМ), куда предварительно записывается информация о всех параметрах ШД - таблица предписанных движений рабочих органов ЗБ-принтера. В компьютере, на основе уравнений системы (4) и заданной величины отрезка по времени , ii+1], осуществляется подсчет необходимого количества управляющих

импульсов для подачи на обмотки ШД в течение каждого временного отрезка.

Структурно-функциональная схема системы управления ШД показана на рисунке 3. Она включает следующие объекты: порт LPT (в силу традиционности использования LPT порта для передачи управляющих импульсов на устройство управления и простоты соответствующих схемотехнических решений); шины даных и управления; контроллер; три электронных драйвера и собственно ШД.

От компьютера по интерфейсу LPT приходят сигналы по первым четырем шинам данных для управления обмотками двигателя ШД; по следующим трем шинам передаются управляющие сигналы выбора ШД. Эти сигналы поступают на контроллер. В нем происходит выбор двигателя, который должен работать в конкретный момент времени, путем подачи сигнала выборки на соответствующий канал ШД. Затем импульсы управления подаются в электронный драйвер, в котором они усиливаются по току и напряжению. В конечном итоге эти преобразованные импульсы передаются на обмотки соответствующих ШД, которые и обеспечивают непосредственное управление режимами работы двигателей.

Рис. 3. Структурно-функциональная схема типичной системы управления ШД. ЛИТЕРАТУРА

1. Батырканов Ж. И., Кадыркулова К. К., Белялов Ш. А. Управление шаговым приводом 3Б-принтера: математическая модель и вопросы технической реализации // Прикаспийский журнал: управление и высокие технологии. - 2016. - № 1 (33). -С. 128-138.

2. Большаков В., Бочков А. и др. Основы 3Б-моделирования. - СПб.: Питер, 2012. -304 с.

3. Карпенко Б. К., Ларченко В. И., Прокофьев Ю. А. Шаговые электродвигатели. -Киев: Техшка, 1972. - 216 с.