摘要(英) |
This study is based on step motor servo control. We simplified the software algorithm and transformed it from floating-point to fixed-point operations, which has successfully increased the control frequency beyond that of the original system.
Additionally, the research employs the quadratic polynomial Lagrange interpolation method to approximate sine and cosine wave calculations. Because sinusoidal waves exhibit symmetrical characteristics, the interpolation method only needs to record one quarter of the wave′s data points, reducing memory usage in the Microcontroller Unit (MCU). However, the calculation process of the quadratic polynomial Lagrange interpolation method requires division, leading to an extended computation time. To address this issue, we divided the full range of the wave (0 to 360 degrees) into 256 parts, with function points representing powers of two. This allowed us to replace division with bitwise operations, significantly reducing program execution time.
In terms of control, we utilized integral (I) for excitation angle feedback and proportional-integral (PI) for current feedback in a dual-loop control system. The I excitation angle feedback is affected by the cogging torque, causing an offset error between the stator and rotor. To eliminate this offset error, the driver needs to provide a counter-torque to offset the cogging torque. PI current feedback is utilized to minimize current, adjusting the required current according to different load conditions and thereby reducing power consumption. |
參考文獻 |
[1] 鄧翔冠,「微步進伺服馬達驅動器設計」,國立中央大學,機械工程學系光機電工程碩士班,碩士論文,2020。
[2] 沈晏平,「應用C4M-OS實作微步進馬達伺服驅動器」,國立中央大學,機械工程學系光機電工程碩士班,碩士論文,2021
[3] 孔崇維,「步進馬達伺服控制驅動器設計改良及校正」。國立中央大學機械工程學系,碩士論文,2022。
[4] 聖釜電機: "步進馬達NEMA8", 2023年7月2日取自: https://www.sumfu.com/step/nema8
[5] Elmenreich, Wilfried, Maximilian Rosenblattl, and Andreas Wolf. "Fixed point library based on ISO/IEC standard DTR 18037 for atmel AVR microcontrollers." 2007 Fifth Workshop on Intelligent Solutions in Embedded Systems. IEEE, 2007.
[6] Cilio, Andrea GM, and Henk Corporaal. "Floating point to fixed point conversion of C code." Compiler Construction: 8th International Conference, CC’99, Held as Part of the Joint European Conferences on Theory and Practice of Software, ETAPS’99, Amsterdam, The Netherlands, March 22-28, 1999. Proceedings 8. Springer Berlin Heidelberg, 1999.
[7] M. Metz, A. Haberli, M. Schneider, R. Steiner, C. Maier and H. Baltes, "Contactless angle measurement using four Hall devices on single chip," Proceedings of International Solid State Sensors and Actuators Conference (Transducers ′97), Chicago, IL, USA, 1997
[8] Hu, Xiaolin, Yanrong Zhang, and Yan Lu. "Research on vector control and subdivision drive technology of two-phase hybrid stepper motor based on SVPWM." IOP Conference Series: Materials Science and Engineering. Vol. 381. No. 1. IOP Publishing, 2018.
[9] ams, "AS5047D 14-Bit On-Axis Magnetic Rotary Position Sensor with 11-Bit Decimal and Binary Incremental Pulse Count," AS5047D datasheet, Jan. 2016 [Revised Apr. 2016].
[10] ams, "AN500 Rotary Mannetic Position Sensors" AS5047D datasheet, Sep. 2016 [v1-04]
[11] Texas Instruments, "DRV8847 Dual H-Bridge Motor Driver," DRV8847 datasheet, July. 2018 [Revised Sept. 2019].
[12] Atmel, ATmega128, "8-bit Atmel Microcontroller with 128KBytes In-System Programmable Flash",
[13] Texas Instruments, " TXS0104E 4-Bit Bidirectional Voltage-Level Translator for Open-Drain and Push-Pull Applications" TXS0104E datasheet, July. 2018 [Revised Oct. 2020].
[14] Analog Devices Inc., "High Voltage, Bidirectional Current Shunt Monitor," AD8210 datasheet, Apr. 2006 [Revised Sept. 2017].
[15] S. -B. Jiang, H. -C. Chuang, C. -W. Kung, X. -G. Deng, Y. -P. Shen and L. -W. Chen, "Innovative Microstepping Motor Controller With Excitation Angle-Current Dual-Loop Feedback Control," in IEEE Access, vol. 11, pp. 62382-62393, 2023, doi: 10.1109/ACCESS.2023.3288023.
[16] 江士標,步進馬達伺服驅動器用圖,國立中央大學光機電工程研究所,未公開文件,2023。
[17] 江士標,步進馬達伺服驅動器規格書,國立中央大學光機電工程研究所,未公開文件,2023。
[18] 江士標,步進馬達伺服驅動器設計書,國立中央大學光機電工程研究所,未公開文件,2023。
[19] 江士標,C4M_SRTOS_M128,國立中央大學光機電工程研究所,未公開文件,2023。
[20] H. -C. Chuang, C. -W. Kung, L. -W. Chen and S. -B. Jiang, "Nonlinear Error Correction for Magnetic Encoders," in IEEE Sensors Journal, vol. 23, no. 9, pp. 9129-9135, 1 May1, 2023, doi: 10.1109/JSEN.2022.3214575. |