基于FPGA的步進(jìn)電機加減速控制器的設計
0 引言
幾十年來(lái),數字技術(shù)、計算機技術(shù)和永磁材料的迅速發(fā)展,為步進(jìn)電機的應用開(kāi)辟了廣闊的前景。由步進(jìn)電機與驅動(dòng)電路組成的開(kāi)環(huán)數控系統,既非常簡(jiǎn)單、廉價(jià),又非??煽?。此外,步進(jìn)電機還廣泛應用于諸如打印機、雕刻機、繪圖儀、繡花機及自動(dòng)化儀表等。正因為步進(jìn)電機的廣泛應用,對步進(jìn)電機的控制的研究也越來(lái)越多,在啟動(dòng)或加速時(shí)若步進(jìn)脈沖變化太快,轉子由于慣性而跟隨不上電信號的變化,產(chǎn)生堵轉或失步;在停止或減速時(shí)由于同樣原因則可能產(chǎn)生超步。為防止堵轉、失步和超步,提高工作頻率,要對步進(jìn)電機進(jìn)行升降速控制。本文介紹一個(gè)用于自動(dòng)磨邊機的步進(jìn)電機升降速控制器,由于考慮了通用性,它可以應用于其他場(chǎng)合。
從步進(jìn)電機的矩頻特性可知,步進(jìn)電機的輸出轉矩隨著(zhù)脈沖頻率的上升而下降,啟動(dòng)頻率越高,啟動(dòng)轉矩就越小,帶動(dòng)負載的能力越差,啟動(dòng)時(shí)會(huì )造成失步,而在停止時(shí)又會(huì )發(fā)生過(guò)沖。要使步進(jìn)電機快速的達到所要求的速度又不失步或過(guò)沖,其關(guān)鍵在于使加速過(guò)程中加速度所要求的轉矩既能充分利用各個(gè)運行頻率下步進(jìn)電機所提供的轉矩,又不能超過(guò)這個(gè)轉矩。因此,步進(jìn)電機的運行一般要經(jīng)過(guò)加速、勻速、減速三個(gè)階段,要求加減速過(guò)程時(shí)間盡量的短,恒速時(shí)間盡量長(cháng)。特別是在要求快速響應的工作中,從起點(diǎn)到終點(diǎn)運行的時(shí)間要求最短,這就必須要求加速、減速的過(guò)程最短,而恒速時(shí)的速度最高。而以前升速和降速大多選擇按直線(xiàn)規律,采用這種方法時(shí),它的脈沖頻率的變化有一個(gè)恒定的加速度。在步進(jìn)電機不失步的條件下,驅動(dòng)脈沖頻率變化的加速度和步進(jìn)電機轉子的角加速度成正比。在步進(jìn)電機的轉矩隨脈沖頻率的上升保持恒定時(shí),直線(xiàn)規律的升降速才是理想的升降速曲線(xiàn),而步進(jìn)電機的轉矩隨脈沖頻率的上升而下降,所以直線(xiàn)就不是理想的升降速曲線(xiàn)。因此,按直線(xiàn)規律升降速這種方法雖然簡(jiǎn)單,但是它不能保證在升降速的過(guò)程中步進(jìn)電機轉子的角加速度的變化和它的輸出力矩變化相適應,不能最大限度的發(fā)揮電機的加速性能。本系統尋求一種基于FPGA控制的按指數規律升降速的離散控制算法,經(jīng)多次運行,達到預期目標。
1 加減速控制算法
1.1 加減速曲線(xiàn)
本設計按照步進(jìn)電機的動(dòng)力學(xué)方程和矩頻特性曲線(xiàn)推導出按指數曲線(xiàn)變化的升降速脈沖序列的分布規律,因為矩頻特性是描述每一頻率下的最大輸出轉矩,即在該頻率下作為負載加給步進(jìn)電機的最大轉矩。因此把矩頻特性作為加速范圍下可以達到(但不能超過(guò))的最大輸出轉矩來(lái)擬訂升降速脈沖序列的分布規律,就接近于最大轉矩控制的最佳升降速規律。這樣能夠使得頻率增高時(shí),保證輸出最大的力矩,即能夠對最大的力矩進(jìn)行跟隨,能充分的發(fā)揮步進(jìn)電機的工作性能,使系統具有良好的動(dòng)態(tài)特性。
由步進(jìn)電機的動(dòng)力學(xué)方程和矩頻特性曲線(xiàn),在忽略阻尼轉矩的情況下,可推導出如下方程:
式中,
為轉子轉動(dòng)慣量,K為假定輸出轉矩按直線(xiàn)變化時(shí)的斜率,τ為決定升速快慢的時(shí)間常數,在實(shí)際工作中由實(shí)驗來(lái)確定。fm為負載轉矩下步進(jìn)電機的最高連續運行頻率,步進(jìn)電機必須在低于該頻率下運行才能保證不失步。(1)式為步進(jìn)電機的升速特性,由此方程可繪制出電機升速曲線(xiàn)。(1)式表明驅動(dòng)脈沖的頻率f應隨時(shí)間t作指數規律上升,這樣就可以在較短的時(shí)間內使步進(jìn)電機的轉速上升至要求的運行速度。鑒于大多數的步進(jìn)電機的矩頻特性都近似線(xiàn)性遞減的,所以上述的控制規律為最佳。
1.2 加減速離散處理
在本系統中,FPGA使用分頻器的方式來(lái)控制步進(jìn)電機的速度,升降速控制實(shí)際上是不斷改變分頻器初載值的大小。指數曲線(xiàn)由于無(wú)法通過(guò)程序編制來(lái)實(shí)現,可以用階梯曲線(xiàn)來(lái)逼近升速曲線(xiàn),不一定每步都計算裝載值。
如圖1所示,縱坐標為頻率,單位是步/秒,其實(shí)反映了轉速的高低。橫坐標為時(shí)間,各段時(shí)間內走過(guò)的步數用N來(lái)表示,步數其實(shí)反映了行程。圖中標出理想升速曲線(xiàn)和實(shí)際升速曲線(xiàn)。
步進(jìn)電機的升速過(guò)程可按以下步驟進(jìn)行處理。
(1)若實(shí)際運行速度為fg,從(3.4)式中可算出升速時(shí)間為:
(2)將升速段均勻地離散為n段即為階梯升速的分檔數,上升時(shí)間為tr,則每檔速度保持時(shí)間為:
程序執行過(guò)程中,對每檔速度都要計算在這檔速度應走的步數,然后以遞減方式檢查,即每走一步,每檔步數減1。當減至零時(shí),表示該檔速度應走的步數己走完,應進(jìn)入下一檔速度。一直循環(huán)到給出的速度大于或等于給定的速度為止。減速過(guò)程與升速過(guò)程剛好相反。
2 頻率脈沖的實(shí)現
頻率脈沖模塊的核心是可控分頻器,由外部的晶振產(chǎn)生標準頻率,只要在分頻器的輸入端輸入相應的分頻系數,就可以得到所需的頻率。本模塊是利用VHDL硬件描述語(yǔ)言,通過(guò)QuartusII開(kāi)發(fā)平臺,使用Altera公司的FPGA,設計了一種能夠滿(mǎn)足上述各種要求的較為通用的可控分頻器。圖2為分頻器的原理圖,圖3為分頻器的仿真波形圖。
3 結語(yǔ)
基于硬件描述語(yǔ)言VHDL設計的控制器具有開(kāi)發(fā)設計周期短、風(fēng)險低、系統集成度高、功耗低等優(yōu)點(diǎn),將是芯片設計的主流方向。開(kāi)放式數控系統中,研究實(shí)現能硬件復用的加減速模塊以及相關(guān)功能模塊,利用可編程邏輯器件FPGA的可重構能力,能按需求靈活實(shí)現功能全定制的運動(dòng)控制芯片。本文設計了自動(dòng)磨邊機中的指數加減速控制器。在此基礎上,只需擴展相應個(gè)數的加減速模塊即可實(shí)現多軸聯(lián)動(dòng)加減速控制。
評論