CC BY
0
КАДЫРКУЛОВА К. К., МАМАТБЕКОВ И. М., БАТЫРКАНОВ Ж. И.
СИНТЕЗ УПРАВЛЕНИЯ ШАГОВЫМИ ПРИВОДАМИ 3D-ПРИНТЕРА Аннотация. Предлагается математический подход к разработке модели управления движениями рабочих органов 3D-принтера привода в виде рекуррентных соотношений. Это позволяет решить задачу синтеза законов управления приводами рабочего органа 3D-принтера для случаев, когда предписанную траекторию его движения аналитически описать невозможно или затруднительно, с меньшими трудностями осуществить программно-техническую реализацию синтезированных законов управления.
Ключевые слова: предписанная программа, траектория, закон управления, объект управления, шаговый привод, 3D-принтер.
KADYRKULOVA K. K., MAMATBEKOV I. M., BATYRKANOV J. I.
CONTROL SYNTHESIS FOR 3D-PRINTER STEP DRIVE Abstract. A mathematical approach to the development of a model for controlling the movements of the working bodies of a 3D-printer drive in the form of recurrent relations is proposed. This makes it possible to solve the problem of synthesizing the laws of control of the drives of the working body of a 3D-printer for cases when it is impossible or difficult to analytically describe the prescribed trajectory of its movement, with less difficulty to implement the software and technical implementation of the synthesized control laws.
Keywords: prescribed program, trajectory, control law, controlled object, step drive, 3D-
printer.
На сегодняшний день проблема управления движением объекта по предписанной траектории более или менее решена для линейных одномерных объектов, когда предписанная траектория задаётся в аналитической форме. Управляемый объект при этом описывается системой уравнений
х = f(x,u,t), x(t0) = х0, (1)
где: х = (х1,х2,...,хп)т — вектор состояния, и = (и1и2,...,ит)т — вектор управления. Принимается, что вектор-функция f(x,u, t) представляет собой непрерывную ограниченную функцию, имеющую частные производные по совокупности переменных х1, х2, ...хп в области определния уравнения (1).
Предписанная траектория движения системы задается в виде уравнений
%(х, t) = 0, г = 1, s, s < п, tE [0, T], 1
где 1¥г - непрерывные функции движения от аргументов.
Для синтеза закона управления формируется полная производная по времени функции х, ^ на движениях системы. В соответствии с (2) она выглядит следующим образом:
а с учетом уравнений движения системы получаем
^.О^^Ж^+д^0. (4)
Разрешая это соотношение относительно искомой функции и(х, находим закон управления, при котором движение объекта осуществляется по предписанной траектории. Но с практической точки зрения задача синтеза будет решена только в том случае, если закон управления обеспечивает также возвращение точки X = (х1, х2..... хп) на предписанную траекторию ^(х, £), если по каким то причина она окажется вне нее. Таким образом, закон управления должен обеспечивать не только процесс движения по предписанной траектории, но и обеспечивать стабилизацию требуемого движения [2].
Для такого закона управления, очевидно, должно выполняться соотношение
^ = = (5)
где Я (р, х, 0 - произвольная функция, обращающаяся в нуль на кривой (2), т. е.
й(0,х,0 = 0. (6)
Попытки синтеза управлений для шагового привода наталкиваются на то, что в большинстве случаев предписанные траектории аналитически описать невозможно. Кроме этого, математическая модель шагового привода, как объекта управления, описывется рекуррентными выражениями, а не непрерывными уравнениями. В связи с этими предлагается новый подход к синтезу законов управления для шаговых приводов.
Выведем математическую модель шагового привода, как объекта управления, а затем рассмотрим процедуру синтеза. Для синтеза законов управления рассмотрим шаговый двигатель с зубчатым передаточным механизмом на валу двигателя. При помощи этого механизма вращательное движение ротора двигателя преобразуется в поступательное движение механизмов (в конечном счете - печатающей головки) ЗБ-принтера.
Пусть на роторном валу шагового двигателя (ШД) посажено (установлено) зубчатое
колесо (шестерня) с радиусом Я и угловым расстоянием между двумя зубьями Аа градусов,
т. е. угол поворота ротора ШД, при действии единичного импульса составляет Аа градусов.
В дальнейшем требуется представить Аа в радианах. Перевод из градусов в радианы
2
осуществляется по следующей формуле:
Да[рад] = ^^^Г4 . (7)
\8Щград\
При действии единичного импульса на ШД с посаженной на валу его ротора шестерней с радиусом Я, одиночный угловой шаг поворота ротора преобразуется в поступательное движение шестерни на расстояние равное
1Ш =Ла- Я, (8)
где: Да - шаг поворота ротора ШД при подаче единичного импульса (градусы); Lш-величина линейного шага шестерни при действии одного импульса на ШД.
Т. к. в ШД шаги осуществляются в дискретные моменты времени, то математическая модель (ММ) ШД, как объекта управления описывается с использованием конечно-разностного выражения
Рк+1 = Рк + пк (Да), (9)
где: рк - текущее угловое положение ротора ШД на 1к -м моменте времени; пк -количество управляющих импульсов подаваемых на ШД за отрезок времени [1к, 1к+1]; рк+1 -угловое положение ротора ШД в tk+1 -й момент времени.
Формула (9) используется тогда, когда требуемые перемещения рабочих органов 3D-принтера описаны в угловых координатах. Однако в большинстве случаев необходимые перемещения описываются в линейных координатах. При этом аналогично (9), предлагается математическая модель (ММ) управления движениями рабочих органов 3D-принтера [3] следующего вида:
[Хк+1 = + пкх^шх; ^к+1 =^к+ пку1шу'> (10)
^к+1 = ^к + пкг^шг,
где: Хк, Ук, 1к - координаты рабочих органов принтера по осям X, У, Ъ в к-й момент времени; Хк+1, Ук+1, Т.к+1 - координаты рабочих органов по осям X, У, Ъ в (к +1) момент времени; пкх, пку, пк2 - количества импульсов поданных на ШД приводов по осям X, У, Ъ за указанный промежуток времени; 1шх =1шу=1ш2 - величины линейных шагов рабочего органа по осям X, У, 2 от действия одиночных импульсов на соответствующие ШД.
Если количество подаваемых на ШД импульсов за шаг по времени для каждой оси движения печатающей головки разное, то для обеспечения лучшего воспроизведения формы детали необходимо решать задачу оптимизации распределения во времени импульсов, подаваемых на ШД с меньшей частотой (более редко).
Для ШД, как объекта управления, целесообразно использовать математическую
3
модель, содержащую выражения, связывающие управляемые величины Хк+1, Ук+1, 1к+1 с управляющими пкх, пку, пк2. Подчеркнем, что эта ММ формально соответствует «независимому» управлению ШД по каждой из осей. Вопросы «синхронизации» импульсов управления при разном их количестве за шаг по времени в данной модели не учитываются.
Таким образом, в практическом плане задача управления ШД сводится к нахождению количества управляющих импульсов ПкХ, Пку, Пк2 из формул (10) и подаче их на соответствующие ШД за отрезок времени ^к, ^к+г]. При этом значения Хк+1, Ук+1, %к+1 берутся из таблицы предписанных (требуемых) контрольных точек пространственной траектории движения рабочих органов ЗБ-принтера (она может строиться в автоматическом или полуавтоматическом режиме на основе компьютерных моделей объектов) [3].
Отметим, что в ряде случаев при планировании использования ЗБ-принтера приходится учитывать и инерционные характеристики ШД и рабочих органов, т. е. возможность корректной (полной) «отработки» ими всех поступивших импульсов управления за заданный промежуток времени.
Проиллюстрируем построение предписанной пространственной траектории движения рабочих органов ЗБ-принтера с помощью рисунка 1.
4
2
Рис. 1. Пространственная модель детали с нанесенными на нее контрольными точками.
По требуемой пространственной модели объекта с нанесенными на нее контрольными точками строим таблицу для предписанной траектории движения рабочего органа 3Б-принтера (таблица 1).
Таблица 1
Предписанные координаты в различных точках траектории
to=0 t1=1 t2=2 t3=3 t4=4
Хк 0 1 2 3 0
Ук 0 1 2 3 0
Zk 0 0 0 3 0
Отметим, что подсчет количества необходимых импульсов по формулам (10) для обеспечения перемещений, задаваемых таблицей 1, может приводить к тому, что расчетное количество импульсов (для определенности - по оси Х) будет выражаться не целым числом
Пк = (Xt+1 -Xk)/ 1Ш . (11)
В этом случае, берется ближайшее целое число (по стандартным правилам округления), а максимальная погрешность позиционирования ШД составит
W = 0.5 1ш . (12)
Следовательно, чтобы уменьшить погрешность позиционирования ШД нужно уменьшить 1Ш. А для этого, в свою очередь, нужно уменьшить величину единичного шага
(поворота ротора) Аа, которая достигается путем выбора ШД с необходимым количеством полюсов (в том числе - эквивалентных полюсов). Необходимая скорость движения ШД обеспечивается путем уменьшения или увеличения величины отрезка по времени [tk, tk+i] -при фиксированных количествах импульсов, которые должны быть поданы на ШД за этот отрезок. Уменьшение отрезка по времени увеличивает скорость движения (перемещения) ШД и, как следствие, печатающей головки.
Предложенная математическая модель управления движениями рабочих органов 3D-принтера была использована при практичсекой реализации системы управления шаговыми приводами для прототипа 3D-принтера. Для управления ШД используется персональный компьютер, куда предварительно записывается информация о всех параметрах ШД, а также данные о предписанных движениях рабочих органов 3D-принтера.
В компьютере, на основе уравнений системы (10) и заданной величины отрезка по времени [t^, t^+i] осуществляется подсчет необходимого количества управляющих импульсов для подачи на обмотки ШД в течение каждого временного отрезка.
Функциональная схема системы управления ШД показана на рисунке 2. Она включает следующие объекты: персональный компьютер с портом USB (в силу традиционности); микроконтроллер; три электронных драйвера и сами ШД. Порт USB традиционно
используется для передачи управляющих импульсов на устройство управления - его использование обеспечивает простоту соответствующих схемотехнических решений.
Рис. 2. Функциональная схема системы управления SD-принтером с использованием Arduino.
Пакет данных, записанный в программный последовательный код персонального компьютера, передается через порт USB в микроконтроллер. Принятые данные преобразуются в три дискретных сигнала для подачи на три входа драйверов каждого ШД. Все время работы ШД на входы EN всех драйверов подается высокий потенциал. В течение всего такта управления на вход DIR драйвера соответствующего двигателя подается низкий потенциал, если необходимо обеспечить направление вращения влево, и высокий потенциал, если необходимо обеспечить направление вращения вправо. При этом на входы STEP драйверов всех двигателей одновременно с частотой выполнения шагов подаются управляющие импульсы высокого уровня длительностью менее периода выполнения шагов, если соответствующий двигатель должен выполнить шаг, и подается низкий потенциал на входы STEP драйверов тех двигателей, для которых все требуемые на данном такте управления шаги уже выполнены. В результате таких действий все драйверы обеспечивают необходимую коммутацию обмоток своих шаговых двигателей, вызывающую одновременный поворот их валов на соответствующее количество шагов в требуемых направлениях [10; 11].
Описанный способ управления несколькими шаговыми двигателями, характеризуется тем, что управляющие импульсы на входы STEP драйверов двигателей за отрезок времени
1шага, в течение которого двигатель должен совершить шаг, формируют с задержкой по времени. Для этого предварительно, до начала управления двигателями измеряют промежуток времени 1л, за который ток потребления драйвера достигает своего среднего значения.
На рисунке 3 показан внешний вид разработанного прототипа 3Б-принтера. При изготовлении опытного прототипа 3Б-принтера взят ШД марки ДС4-6В и винтовой редуктор с длиной винта 84 мм и диаметром 3 мм. При эксперименте установлен, что винтовой редуктор за одиночный импульс перемещает нагрузку на 1,6 мм. Следовательно, 1шх =1шу=1ш2=1,6 мм.
Рис. 3. Внешний вид разработанного прототипа ЗБ-принтера.
Работоспособность опытного прототипа ЗБ-принтера подтверждена экспериментально.
СПИСОК ЛИТЕРАТУРЫ
1. Батырканов Ж. И., Кадыркулова К. К. Траекторное управление объектом по таблично заданным программам // Известия КГТУ. - 2011. - № 24. - С. 290-295.
2. Батырканов Ж. И., Кадыркулова К. К. Синтез законов управления по осуществлению движения управляемого объекта по предписанной программе // Вестник науки Костанайского социально-технического университета имени академика Зулхарной Алдамжар. - 2013. - № 3. - С. 29-33.
3. Батырканов Ж. И., Кадыркулова К. К., Белялов Ш. А. Управление шаговым приводом 3D-принтера: математическая модель и вопросы технической реализации // Прикаспийский журнал: управление и высокие технологии. - 2016. - № 1 (33). — C.128-138.
4. Беллман Р. Введение в теории матриц. - М.: Наука, 1969. - 368 с.
5. Бойчук Л. М. Метод структурного синтеза нелинейных систем автоматического управления. - М.: Энергия, 1971. - 185 с.
6. Денисов Г. С., Снимщиков И. А. Микроконтроллеры. - Бишкек, 2014. - 183 с.
7. Блум Дж. Изучаем Arduino: инструменты и методы технического волшебства / Пер. с англ. - СПб.: БХВ-Петербург, 2017. - 336 с.
8. Евстифеев А. В. Микроконтроллеры AVR семейств Tiny и Mega фирмы «ATMEL».
- М.: Издательский дом «Додэка-ХХ1», 2004. - 560 с.
9. Егоров О. Д., Подураев Ю. В. Мехатронные модули. Расчет и конструирование: учеб. пособие. - М.: МГТУ «СТАНКИН», 2004. - 360 с.
10. Иванов А. И. Способ потактового управления несколькими шаговыми двигателями с помощью персонального компьютера по каналу USB и устройство для его осуществления. - М.: МГТУ «СТАНКИН», 2019. - 45 с.
11. Крутько П. Д. Обратные задачи динамики управляемых систем: Линейные модели.
- М.: Наука, 1987. - 304 с.
12. Мелешин В. И., Овчинников Д. А. Управление транзисторными преобразователями электроэнергии. - М.: Техносфера, 2011. - 200 с.
13. Ратмиров В. А. Системы с шаговыми двигателями. - М.; Л.: Энергия, 1964. - 136 с.
14. Шаршеналиев Ж. Ш., Батырканов Ж. И. Синтез систем управления с заданными показателями качества. - Бишкек: Илим, 1991. - 174 с.
