基于SoPC的步進(jìn)電機(jī)多軸控制器
摘要:闡述了一種基于SOPC的步進(jìn)電機(jī)多軸控制器。該控制器應(yīng)用于半自動(dòng)生化分析儀中,以實(shí)現(xiàn)取樣針移位系統(tǒng)的控制功能,同時(shí)它也能夠用于其他類似如多軸聯(lián)動(dòng)的針式打印機(jī)及機(jī)器人等領(lǐng)域的多步進(jìn)電機(jī)工作的場(chǎng)合。
本文引用地址:http://m.butianyuan.cn/article/149014.htm關(guān)鍵詞:可編程片上系統(tǒng)多軸控制器步進(jìn)電機(jī)生化儀
步進(jìn)電機(jī)是一種完全數(shù)字化的電動(dòng)執(zhí)行機(jī)構(gòu),從原理上說(shuō),其角位移與驅(qū)動(dòng)脈沖的個(gè)數(shù)成正比,在正常情況下,步進(jìn)電機(jī)具有使用簡(jiǎn)單、運(yùn)動(dòng)精確、連續(xù)運(yùn)行無(wú)累積誤差等特點(diǎn),因而被廣泛應(yīng)用于各種位置控制系統(tǒng)中。當(dāng)前由于儀器內(nèi)部的機(jī)械系統(tǒng)日益復(fù)雜,其運(yùn)動(dòng)往往是多自由度的,因而通常需要利用多個(gè)步進(jìn)電機(jī)的運(yùn)動(dòng)合成來(lái)實(shí)現(xiàn)系統(tǒng)的各種動(dòng)作。例如,對(duì)圖1所示的半自動(dòng)生化分析儀的取樣針移位系統(tǒng),該系統(tǒng)的動(dòng)作執(zhí)行就是由兩部分組成的:一是固定基座上的步進(jìn)電機(jī)控制取樣橫臂進(jìn)行垂直方向上的升降運(yùn)動(dòng);二是滑塊上的步進(jìn)電機(jī)控制取樣橫臂進(jìn)行水平方向上的旋轉(zhuǎn)運(yùn)動(dòng)。這兩個(gè)運(yùn)動(dòng)的合成實(shí)現(xiàn)了取樣橫臂的位置變換。
傳統(tǒng)的步進(jìn)電機(jī)多軸控制器是以微控制器(MCU)/微處理器(MPU)/專用集成電路(ASIC)/數(shù)字信號(hào)處理器(DSP)為核心,再輔以其他外圍分立器件構(gòu)成的。這種結(jié)構(gòu)的步進(jìn)電機(jī)多軸控制器的優(yōu)點(diǎn)在于其硬件結(jié)構(gòu)清晰,易于復(fù)制再現(xiàn),對(duì)于類似的應(yīng)用只需要修改其應(yīng)用軟件即可。然而對(duì)于多數(shù)實(shí)際應(yīng)用來(lái)說(shuō),單純依靠軟件的修改通常不足以使其達(dá)到其他應(yīng)用場(chǎng)合所需的要求,并且當(dāng)系統(tǒng)升級(jí)時(shí),通常需要對(duì)整個(gè)電路重新進(jìn)行設(shè)計(jì),這樣既延長(zhǎng)了升級(jí)的周期,又增加了升級(jí)成本。因而在實(shí)際應(yīng)用中受到了一定的限制。由于可編程邏輯器件(PLD)技術(shù)的飛速發(fā)展,使得單一FPGA/CPLD芯片內(nèi)部可以集成多個(gè)分立元件的功能,因此在對(duì)傳統(tǒng)控制器的改進(jìn)中,通常使用一個(gè)FPGA/CPLD芯片將傳統(tǒng)控制器中的數(shù)字電路部分集成到一起,從而形成具有處理器一FPCA/CPLD-模擬電路結(jié)構(gòu)形式的控制器。這類控制器比起傳統(tǒng)控制器而言,其硬件結(jié)構(gòu)的可擴(kuò)展性得到了很大的提高。這是因?yàn)镕PGA/CPLD芯片具有在不改變其引腳定義的情況下可對(duì)其內(nèi)部邏輯關(guān)系進(jìn)行重構(gòu)的特性,因而對(duì)于不同的應(yīng)用,可以通過(guò)改變FPGA/CPLD芯片的內(nèi)部結(jié)構(gòu)來(lái)滿足某些特殊的應(yīng)用需求,從而在一定程度上使得系統(tǒng)的開(kāi)發(fā)升級(jí)更為簡(jiǎn)便,而且成本也更為低廉。因此,這種改進(jìn)型的多步進(jìn)電機(jī)控制器的應(yīng)用范圍也得到了很大的擴(kuò)展。但是,這種結(jié)構(gòu)的控制器也存在著這樣的問(wèn)題:在FPGA外部仍然存在一個(gè)處理器。這樣不僅增加了控制器的尺寸,而且在升級(jí)處理器時(shí),硬件電路需要重新設(shè)計(jì),使升級(jí)成本仍然相對(duì)較高。
近年來(lái),由于IP資源復(fù)用理念得到了普遍的認(rèn)同并成為主要設(shè)計(jì)方式,MCU、DSP、MPU等嵌入式處理器IP成為了FPGA應(yīng)用的核心。隨著處理器內(nèi)核以IP的形式嵌入到FPGA中,未來(lái)的電路板上可能只有兩部分電路:模擬部分(包括電源)以及FPGA芯片和一些大容量存儲(chǔ)器。這一切都表明可編程片上系統(tǒng)(SOPC)正在成為FPGA最重要的發(fā)展方向。與傳統(tǒng)多軸控制器相比。這種基于SOPC的步進(jìn)電機(jī)多軸控制器具有體積小、集成度高、硬件結(jié)構(gòu)穩(wěn)定、易于開(kāi)發(fā)升級(jí)且成本低廉等特點(diǎn),尤其適用于儀器儀表內(nèi)部控制系統(tǒng)的設(shè)計(jì)。本文所論述的步進(jìn)電機(jī)多軸控制器就是基于SOPC方式的步進(jìn)電機(jī)多軸控制器。
1基于SOPC的步進(jìn)電機(jī)多軸控制器的硬件結(jié)構(gòu)
基于SOPC的步進(jìn)電機(jī)多軸控制器的結(jié)構(gòu)框圖如圖2所示。其外部電路的構(gòu)成包含模擬電路和數(shù)宇電路兩部分。模擬電路包括供電電源及功率驅(qū)動(dòng)。數(shù)字電路主要為FPGA芯片及其相關(guān)電路。
如圖2,基于SOPC的步進(jìn)電機(jī)多軸控制器包含兩部分:FPGA芯片及其配置芯片的數(shù)字部分和電機(jī)控制及位置反饋部分。其中,虛線框內(nèi)部表示FPGA芯片的內(nèi)部結(jié)構(gòu),空心箭頭表示FPGA芯片內(nèi)部的數(shù)據(jù)連線,實(shí)心箭頭表示外部連線。FPGA芯片內(nèi)部由MPU模塊、通訊模塊、RAM模塊、ROM模塊、計(jì)數(shù)器模塊、電機(jī)控制模塊等構(gòu)成。當(dāng)控制器失電時(shí),這些模塊信息存儲(chǔ)在配置芯片中,等到系統(tǒng)重新上電時(shí),F(xiàn)PGA芯片再?gòu)呐渲眯酒凶x取其配置信息,重構(gòu)內(nèi)部模塊結(jié)構(gòu)。MPU模塊是整個(gè)控制器的核心,它的功能等同于事實(shí)的微處理器。它通過(guò)通訊模塊與外部主機(jī)進(jìn)行數(shù)據(jù)的交換,并將數(shù)據(jù)存儲(chǔ)在RAM模塊中。RAM模塊同時(shí)還用于暫存MPU模塊執(zhí)行ROM模塊所存儲(chǔ)的程序段時(shí)的某些中間過(guò)程值,而MPU則根據(jù)ROM模塊中程序執(zhí)行的結(jié)果輸出相應(yīng)的控制信號(hào)給電機(jī)控制模塊。電機(jī)控制模塊的輸出連接到實(shí)際的芯片引腳上,以驅(qū)動(dòng)相應(yīng)的功率驅(qū)動(dòng)電路工作,從而實(shí)現(xiàn)步進(jìn)電機(jī)的運(yùn)轉(zhuǎn)。在閉環(huán)控制時(shí),步進(jìn)電機(jī)軸端的編碼器模塊輸出編碼信號(hào)。該信號(hào)經(jīng)編碼器反饋電路進(jìn)行隔離等處理之后,由FPGA芯片內(nèi)部的計(jì)數(shù)器模塊進(jìn)行計(jì)數(shù),并將結(jié)果傳輸給MPU模塊進(jìn)行處理,從而形成位置/速度的閉環(huán)控制。圖2只表示了單個(gè)步進(jìn)電機(jī)閉環(huán)控制的結(jié)構(gòu)框圖,對(duì)于多軸步進(jìn)電機(jī)而言,F(xiàn)PGA芯片只需要增加相應(yīng)的功率驅(qū)動(dòng)電路及編碼器反饋電路即可。電機(jī)控制模塊和計(jì)數(shù)器模塊都在FPGA內(nèi)部集成,因而硬件電路的結(jié)構(gòu)較為穩(wěn)定。
由于IP技術(shù)的飛速發(fā)展,在圖2中的FPGA芯片內(nèi)部模塊中,MPU、ROM、RAM、計(jì)數(shù)模塊等的IP核都可以很方便地獲得,而電機(jī)控制模塊由于與具體的功率放大電路實(shí)際相關(guān),因而通常需要用戶自行設(shè)計(jì)。下面介紹這一模塊的設(shè)計(jì)。
2二相步進(jìn)電機(jī)控制模塊結(jié)構(gòu)
以小慣量的二相步進(jìn)電機(jī)為例闡述步進(jìn)電機(jī)控制模塊的結(jié)構(gòu)。該步進(jìn)電機(jī)由兩片PBL3717a芯片所驅(qū)動(dòng)。其驅(qū)動(dòng)時(shí)序及其控制模塊如圖3、圖4所示。
在控制模塊中,mtr_cp為步進(jìn)電機(jī)的脈沖輸入端,每個(gè)脈沖驅(qū)動(dòng)步進(jìn)電機(jī)前進(jìn),后退一步,脈沖頻率即為步進(jìn)電機(jī)運(yùn)行的速度,因此這個(gè)脈沖信號(hào)由MPU模塊根據(jù)ROM內(nèi)部程序的執(zhí)行結(jié)果輸出。mtr_dir為步進(jìn)電機(jī)的正/反轉(zhuǎn)切換信號(hào),mtr_mode為步進(jìn)電機(jī)全/半步運(yùn)行方式選擇,mtr_on_off是電機(jī)的啟停位,該位置l時(shí),mtr_cp能夠驅(qū)動(dòng)步進(jìn)電機(jī)工作;為O時(shí),mtr_cp脈沖被封鎖。設(shè)置該位的目的是為了在多個(gè)步進(jìn)電機(jī)工作時(shí)分別控制各個(gè)電機(jī)的啟停而不影響到其他電機(jī)的運(yùn)行狀態(tài)。mtr_reset是控制模塊復(fù)位信號(hào),A_out為圖3中下標(biāo)為A的驅(qū)動(dòng)芯片控制信號(hào),B_out為圖3中下標(biāo)為B的驅(qū)動(dòng)芯片的控制信號(hào)。步進(jìn)電機(jī)的控制模塊的仿真波形圖如圖5所示。從圖5可以看出,仿真波形完全符合圖2中步進(jìn)電機(jī)的驅(qū)動(dòng)時(shí)序,即控制模塊的設(shè)計(jì)滿足預(yù)定的設(shè)計(jì)需求。
評(píng)論