《電子技術(shù)應(yīng)用》
您所在的位置:首頁 > 嵌入式技術(shù) > 設(shè)計應(yīng)用 > 步進(jìn)電機控制系統(tǒng)的設(shè)計及應(yīng)用
步進(jìn)電機控制系統(tǒng)的設(shè)計及應(yīng)用
2015年電子技術(shù)應(yīng)用第11期
馬文斌,楊延竹,洪 運
(東華大學(xué) 機械工程學(xué)院,上海201620)
摘要: 基于DSP的步進(jìn)電機控制系統(tǒng)采用了閉環(huán)控制方式,同時以光電編碼器反饋檢測信號以及專用大功率驅(qū)動芯片THB6064H的應(yīng)用不僅簡化了系統(tǒng)外圍硬件電路結(jié)構(gòu),而且增強了系統(tǒng)的可靠性和抗干擾能力,并根據(jù)工程實際中出現(xiàn)的問題進(jìn)行分析并且提出了具體解決措施。對系統(tǒng)的軟硬件方案設(shè)計及部分外圍電路進(jìn)行了簡要介紹,通過對步進(jìn)電機位移的實時控制實現(xiàn)了數(shù)控機床中刀具進(jìn)給的快速跟蹤定位,對DSP在步進(jìn)電機控制系統(tǒng)中的進(jìn)一步開發(fā)應(yīng)用提供了借鑒。
中圖分類號: TP271
文獻(xiàn)標(biāo)識碼: A
DOI:10.16157/j.issn.0258-7998.2015.11.003

中文引用格式: 馬文斌,楊延竹,洪運. 步進(jìn)電機控制系統(tǒng)的設(shè)計及應(yīng)用[J].電子技術(shù)應(yīng)用,2015,41(11):11-13.
英文引用格式: Ma Wenbin,Yang Yanzhu,Hong Yun. Design and application of the stepper motor control system[J].Application of Electronic Technique,2015,41(11):11-13.
Design and application of the stepper motor control system
Ma Wenbin,Yang Yanzhu,Hong Yun
College of Mechanical Engineering,Donghua University,Shanghai 201620,China
Abstract: Stepping motor control system based on DSP adopts the closed-loop control method, at the same time with the photoelectric encoder feedback signal, and the application of special high power drive chip THB664H peripheral hardware circuit not only simplifies the system structure, and enhance the system reliability and anti-interference ability, and according to the actual engineering problems arising from the analysis and the concrete solving measures are put forward .Part of the software and hardware design and the system has carried on the brief introduction of the peripheral circuit, based on the real-time control of stepping motor displacement implements in CNC machine tool feed tracking quickly and to DSP in the control system of the stepper motor to provide reference for further development and application.
Key words : stepper motor;closed loop;feedback;DSP


0 引言

  步進(jìn)電機是將數(shù)字信息直接轉(zhuǎn)換為角位移的控制元件,因其控制簡便、起停迅速以及步進(jìn)精確等特點,被廣泛應(yīng)用于數(shù)控機床、機器人等自動化控制領(lǐng)域。尤其在數(shù)控設(shè)備的刀具快速定位系統(tǒng)中,因?qū)ξ恢煤退俣瓤刂朴兄^高要求,以單片機作為控制系統(tǒng)的主處理芯片在系統(tǒng)穩(wěn)定性以及處理速度上制約著系統(tǒng)實時性和快速性。通過采用DSP(Digital Signal Processor)芯片作為作為主控制芯片的步進(jìn)電機閉環(huán)控制系統(tǒng),在功率驅(qū)動電路設(shè)計上采用東芝公司的THB664H專用驅(qū)動芯片,極大地簡化了外圍硬件電路,使得控制器和驅(qū)動器一體化設(shè)計更為簡便。本文詳細(xì)介紹了步進(jìn)電機閉環(huán)控制系統(tǒng)的主要硬件電路和軟件設(shè)計過程。

1 步進(jìn)電機的控制系統(tǒng)結(jié)構(gòu)

  1.1 DSP簡介

  DSP即數(shù)字信號處理器,是一種專門用來實現(xiàn)各種數(shù)字信號處理算法的微處理器。文中選用TI公司的TMS320F2812作為主控制芯片,片內(nèi)集成了豐富的外設(shè)模塊,簡化了系統(tǒng)的硬件設(shè)計;快速的中斷處理能力和硬件I/O支持,保證了系統(tǒng)實時響應(yīng)的能力;片內(nèi)具有快速RAM同時采用改進(jìn)的哈佛總線結(jié)構(gòu),可以通過獨立的總線對多個存儲器進(jìn)行并行訪問而且可同時完成獲取指令和數(shù)據(jù)讀取操作。與常用的16位單片機相比,DSP可用于復(fù)雜的數(shù)字信號算法處理,在實時性和靈活性上以及高速的數(shù)據(jù)處理能力上有著明顯的優(yōu)勢。

  1.2 系統(tǒng)總體方案設(shè)計

  因為步進(jìn)電機驅(qū)動器本身也屬于數(shù)字器件,且位置和速度等組成的閉環(huán)反饋都可以通過廣電編碼器等傳感器來實現(xiàn)數(shù)字化,因此在步進(jìn)電機閉環(huán)控制系統(tǒng)中選用DSP作為處理器。TMS320F2812通過串口接收上位機的位置指令,并通過接收與步進(jìn)電機同軸轉(zhuǎn)動的光電編碼器發(fā)出的位置反饋脈沖信號作為中斷信號,DSP根據(jù)所計算出的差值信息,發(fā)送位置脈沖和方向脈沖信號給驅(qū)動器,由驅(qū)動器驅(qū)動步進(jìn)電機工作。并通過液晶實時顯示出電機位置及速度等信息,通過整個系統(tǒng)的閉環(huán)控制從而實現(xiàn)數(shù)控設(shè)備中刀具的快速精確跟蹤定位。文中DSP控制系統(tǒng)通過控制兩個56BYG250C兩相步進(jìn)電機從而控制刀具在X、Y方向位移,系統(tǒng)的總體框圖如圖1所示。

001.jpg

2 硬件電路設(shè)計

  步進(jìn)電機控制系統(tǒng)主要由DSP控制單元、電源模塊、串口通信電路、反饋檢測單元、功率驅(qū)動模塊、復(fù)位電路等組成。以下詳細(xì)介紹了串口通信電路以及功率驅(qū)動電路等控制電路的設(shè)計過程。

  2.1 串口通信電路設(shè)計

  串口通信模塊的SCI接口采用發(fā)送和接收雙線異步通信接口。系統(tǒng)DSP控制單元需要通過與上位機通信進(jìn)行數(shù)據(jù)交換,上位機的高低電平為±12 V,DSP的高低電平為0~3.3 V,故而需要進(jìn)行電平轉(zhuǎn)換。系統(tǒng)采用了常見的MAX232電平轉(zhuǎn)換芯片,其輸出的電平經(jīng)過分壓電阻進(jìn)一步的壓降產(chǎn)生3.3 V電壓后與DSP管腳直接連接。串口通信模塊電路如圖2所示。

002.jpg

  2.2 功率驅(qū)動電路設(shè)計

  THB664H是一款專業(yè)的PWM斬波兩相步進(jìn)電機專用驅(qū)動芯片。內(nèi)部高度集成了衰減模式設(shè)置、細(xì)分、CMOS功率放大等電路。配以簡單的外圍電路就可以實現(xiàn)高性能、多細(xì)分、大電流的驅(qū)動電路。通過4位8檔細(xì)分控制(1/2、1/8、1/16、1/20、1/32、1/40、1/64),內(nèi)置過熱欠壓保護(hù)和電流檢測。功率驅(qū)動部分電路圖見圖3。

003.jpg

  為提高控制系統(tǒng)的可靠性,避免因負(fù)載變化而產(chǎn)生過電流損壞控制芯片及驅(qū)動芯片,故采用了HCPL2530高速光電耦合器進(jìn)行信號隔離,不僅完成了控制信號的電平轉(zhuǎn)換和實現(xiàn)了各器件間的有效隔離,同時也對控制信號進(jìn)行整形,提高了系統(tǒng)的整體控制精度。硬件電路設(shè)計中光耦隔離模塊兩側(cè)電路電源必須分別采用獨立的供電電源。

3 軟件設(shè)計

  3.1 步進(jìn)電機的位置檢測

  步進(jìn)電機是將電脈沖信號轉(zhuǎn)變?yōu)榻俏灰苹蚓€位移的開環(huán)控制元件。在非超載情況下,步進(jìn)電機驅(qū)動器接收一個脈沖信號就按預(yù)定方向驅(qū)動步進(jìn)電機轉(zhuǎn)動一個固定角度。DSP2812中事件管理模塊的定時器和比較單元可用來產(chǎn)生兩路電機所需的位置信號脈沖。

  當(dāng)DSP事件管理器EV的捕獲單元QEP模塊被使能,與步進(jìn)電機同軸轉(zhuǎn)動的光電編碼器產(chǎn)生的相差四分之一周期的正交脈沖序列被作為事件管理器中計數(shù)寄存器的時鐘源,從而獲得光電編碼器反饋的脈沖個數(shù)。事件管理器的計數(shù)器寄存器會在正交脈沖的每個跳變沿按照脈沖捕獲的先后順序進(jìn)行定向的計數(shù)增減,進(jìn)而確定步進(jìn)電機的轉(zhuǎn)向和電機轉(zhuǎn)過角度。電機相對于初始位置的角度為:

  1.png

  n為計數(shù)寄存器的當(dāng)前值,n1為計數(shù)寄存器的初始值,L為光電編碼器線數(shù)。

  3.2 控制系統(tǒng)主程序系統(tǒng)設(shè)計

  系統(tǒng)開始運行后首先要進(jìn)行初始化設(shè)置,然后對初始位置和預(yù)定位置進(jìn)行差值比較,根據(jù)位置差值判斷步進(jìn)電機下一時刻轉(zhuǎn)向,并通過改變I/O 口電平的高低控制電機轉(zhuǎn)向。電機運轉(zhuǎn)過程中的脈沖n計算公式為:

  2.png

  式中,為初始位置與預(yù)定的差值,r為步進(jìn)電機的步距角。

  DSP控制器通過改變事件管理器中周期寄存器和比較寄存器的值,進(jìn)而調(diào)整PWM波的頻率和寬度,實現(xiàn)脈沖信號連續(xù)平穩(wěn)的發(fā)送。主程序流程圖如圖4所示。

004.jpg

4 軟件設(shè)計中的一些問題

  4.1 A/D采樣中的濾波

  系統(tǒng)對電流控制的準(zhǔn)確性和精度決定了步進(jìn)電機的運行性能,對電流的閉環(huán)控制需要進(jìn)行A/D采樣來完成,但是控制系統(tǒng)在實際工作中的干擾是不可避免的,因此在電流的A/D采樣電路中必須要采用相應(yīng)的濾波措施來減小干擾。例如在電流的硬件部分采用二階低通濾波,在軟件設(shè)計中也需要采用滑動平均值濾波方式等相應(yīng)的濾波措施來進(jìn)一步提高控制系統(tǒng)的性能。

  4.2 運算中溢出問題的解決以及計算精度的提高

  在程序計算過程中需要考慮運算溢出的問題。在計算電機角位移θ時,程序給直角進(jìn)行格式標(biāo)定,在捕獲單元中斷子程序中,每一次步距角累加后都需要將角位移θ的值和7FFFH相與以避免溢出?;谟嬎憔鹊目紤],在程序中采用了32位乘法和加法運算。采用DSP2812中的16×16的硬件乘法器,需要用兩個16位數(shù)來保存其乘法計算的結(jié)果,加法運算中為了和乘法運算結(jié)果匹配也需要用32位,計算結(jié)束后將從32位計算結(jié)果中選取合適的16位作為輸出。

5 結(jié)論

  在分析了步進(jìn)電機工作原理和主要特點的基礎(chǔ)上,設(shè)計了以TMS320F2812作為主控芯片的步進(jìn)電機閉環(huán)控制系統(tǒng)的硬件電路和運行軟件,實現(xiàn)了控制與驅(qū)動的一體化,相比較開環(huán)控制系統(tǒng)中的失步現(xiàn)象得以有效控制;光電編碼器的檢測反饋電路以及SCI串口通信電路等實現(xiàn)了對步進(jìn)電機位置的精確閉環(huán)控制。結(jié)果表明,所建立的步進(jìn)電機閉環(huán)控制系統(tǒng)有效提高了刀具定位精度,滿足快速響應(yīng)要求。

參考文獻(xiàn)

  [1] 劉和平,鄧力.DSP原理及電機控制應(yīng)用[M].北京:北京航空航天大學(xué)出版社,2006.

  [2] 孫麗明.TMS320F2812原理及其C語言程序開發(fā)[M].北京:清華大學(xué)出版社,2008.

  [3] 馬永軍,劉霞,李正生.DSP原理與應(yīng)用[M].北京:北京郵電大學(xué)出版社,2008.

  [4] 陳壽坤.基于微機原理的步進(jìn)電機控制[J].機電技術(shù):2012(5):28-30.

  [5] 范超毅,范巍.步進(jìn)電機的選型與計算[J].機床與液壓,2008(5):310-313.

  [6] 宰文嬌,汪華章.步進(jìn)電機驅(qū)動控制系統(tǒng)的設(shè)計和實現(xiàn)[J].工礦機械,2013(6).

  [7] 宋蓓,杜娟,宋世芳.基于DSP的開放式運動控制器的設(shè)計[J].電機與控制應(yīng)用,2009(4):23-25.

  [8] 東芝公司數(shù)據(jù)資料,THB664H/HQ.PDF[Z].2012.

  [9] 于增坤,侯文,劉沛堯.一種新的自適應(yīng)M/T電機測速算法[J].微特電機,2014(11):51-53.

  [10] 熊遠(yuǎn)生,錢蘇翔,高金鳳.基于DSP的步進(jìn)電機控制系統(tǒng)與上位機的串行通信設(shè)計[J].機電工程,2004(9):17-21.

  [11] 田心軍.基于DSP的步進(jìn)電機控制系統(tǒng)[D].長沙:湖南大學(xué),2014.


此內(nèi)容為AET網(wǎng)站原創(chuàng),未經(jīng)授權(quán)禁止轉(zhuǎn)載。