山東大學(xué)控制科學(xué)與工程學(xué)院（濟(jì)南250061） 高芳紅 劉錦波

1 引言

運(yùn)動(dòng)控制系統(tǒng)作為先進(jìn)制造領(lǐng)域內(nèi)計(jì)算機(jī)數(shù)控技術(shù)（CNC）中的一個(gè)核心組成部分正在發(fā)揮著越來(lái)越重要的作用。無(wú)論是在工業(yè)機(jī)器人、精密加工還是在塑料機(jī)械、化工、軋鋼等領(lǐng)域到處都能看到運(yùn)動(dòng)控制系統(tǒng)的使用。同時(shí)人們對(duì)運(yùn)動(dòng)控制系統(tǒng)的性能指標(biāo)也提出了更高要求。除PID以及基于極點(diǎn)配置的線性控制策略外，各類新型非線性控制策略的提出也為滿足這一要求提供了發(fā)展空間[1][2]。高性能的DSP、FPGA以及各類新型高速電力電子器件和PWM技術(shù)的出現(xiàn)為這些控制策略的實(shí)時(shí)實(shí)現(xiàn)提供了可能[6]。

本文對(duì)由永磁無(wú)刷直流電機(jī) （BLDC）組成的多軸運(yùn)動(dòng)控制系統(tǒng)進(jìn)行了研究。傳統(tǒng)的多軸運(yùn)動(dòng)控制系統(tǒng)多采用多個(gè)運(yùn)動(dòng)控制系統(tǒng)組合組成。這種結(jié)構(gòu)體積較大、接線復(fù)雜、從而帶來(lái)設(shè)備的可靠性降低。為此，本文提出了一種新的多軸運(yùn)動(dòng)控制系統(tǒng)結(jié)構(gòu)。其每臺(tái)電機(jī)是通過(guò)同一DSP控制的，多臺(tái)逆變器便于集中。除此之外，多軸運(yùn)動(dòng)控制系統(tǒng)的編碼器以及BLDC電機(jī)的霍爾元件也由該DSP統(tǒng)一處理，因而大大簡(jiǎn)化了結(jié)構(gòu)和系統(tǒng)接線，提高了系統(tǒng)的可靠性。這種結(jié)構(gòu)的多軸運(yùn)動(dòng)控制系統(tǒng)可廣泛應(yīng)用于多軸小型設(shè)備如視頻檢測(cè)機(jī)、小型機(jī)器人等。

2 多軸永磁BLDC電機(jī)的運(yùn)動(dòng)控制系統(tǒng)構(gòu)成

2.1 單軸永磁BLDC驅(qū)動(dòng)系統(tǒng)的組成、調(diào)速原理與機(jī)械特性

圖1為單軸永磁BLDC電機(jī)的系統(tǒng)組成框圖。圖1中逆變器采用“導(dǎo)通型”開(kāi)關(guān)規(guī)律，通過(guò)對(duì)逆變器中的三只共射極的IGBT開(kāi)關(guān)管進(jìn)行PWM控制，實(shí)現(xiàn)永磁BLDC電機(jī)的調(diào)壓調(diào)速。其相應(yīng)的穩(wěn)態(tài)機(jī)械特性可以用下式表示為：

根據(jù)（1）式繪出直線永磁BLDC電機(jī)的機(jī)械特性如圖2所示[1]。

由圖2可見(jiàn)，通過(guò)改變PWM的占空比 !調(diào)節(jié)電樞電壓的平均值便可以實(shí)現(xiàn)對(duì)永磁BLDC電機(jī)的速度調(diào)節(jié)。

2.2 單軸永磁BLDC電機(jī)運(yùn)動(dòng)控制系統(tǒng)的構(gòu)成

單軸永磁BLDC電機(jī)的運(yùn)動(dòng)控制系統(tǒng)如圖3所示。圖中，轉(zhuǎn)子的位置信息由安裝在轉(zhuǎn)軸上的編碼器測(cè)量獲得。為了提高精度，轉(zhuǎn)子轉(zhuǎn)速的信息則通過(guò)瞬時(shí)速度觀測(cè)器計(jì)算獲得（具體設(shè)計(jì)方法見(jiàn)3.2節(jié)）。轉(zhuǎn)子的位置信息與轉(zhuǎn)速的反饋信息一起，分別與位置和轉(zhuǎn)速的給定指令作差后通過(guò)控制算法處理獲得電樞電流的參考值。

上述電樞電流的參考值與實(shí)際電樞電流作差，經(jīng)電流PI控制器調(diào)節(jié)輸出，獲得電樞電壓的控制量大小。然后，通過(guò)PWM改變占空比達(dá)到調(diào)壓調(diào)速的目的。

2.3 多軸永磁BLDC電機(jī)運(yùn)動(dòng)控制系統(tǒng)的構(gòu)成

利用圖3組成的單軸運(yùn)動(dòng)控制系統(tǒng)結(jié)構(gòu)，便可獲得多軸永磁BLDC電機(jī)組成的運(yùn)動(dòng)控制系統(tǒng)如圖4所示。

圖4中，采用單一DSP控制三臺(tái)永磁BLDC電機(jī)。每一臺(tái)BLDC電機(jī)的位置與轉(zhuǎn)速的控制算法以及結(jié)構(gòu)均與圖3相同。圖中，由上位機(jī)PC機(jī)實(shí)現(xiàn)運(yùn)動(dòng)控制系統(tǒng)的人機(jī)界面交互以及運(yùn)動(dòng)控制系統(tǒng)控制參數(shù)的修改、狀態(tài)信息的獲得以及故障指示等功能。而具體實(shí)時(shí)運(yùn)算、狀態(tài)量的檢測(cè)與處理、故障處理PWM脈寬信號(hào)的調(diào)整則完全由下位機(jī)DSP完成。上位機(jī)PC與下位機(jī)DSP之間的通訊則通過(guò)RS232串口或CAN總線實(shí)現(xiàn)。

3 多軸永磁BLDC電機(jī)運(yùn)動(dòng)控制系統(tǒng)的設(shè)計(jì)

根據(jù)系統(tǒng)要求，選擇AD公司的DSP（型號(hào)為ADSP2181）作為主微處理器（外部時(shí)鐘頻率為33MHZ）和XLINX公司的FPGA（型號(hào)為XC5204）配合完成運(yùn)動(dòng)控制系統(tǒng)的所有運(yùn)算。通過(guò)FLASH實(shí)現(xiàn)FPGA配置程序和運(yùn)行程序的存儲(chǔ)。圖5、圖6分別給出了運(yùn)動(dòng)控制板和驅(qū)動(dòng)板的原理框圖。其中，原理圖的設(shè)計(jì)采用美國(guó)PADS軟件公司的POWERLOGIC完成。充分利用其與PCB設(shè)計(jì)的OLE（對(duì)象連接嵌入）技術(shù)，實(shí)現(xiàn)原理圖與PCB圖之間的相互發(fā)送和接受，從而給設(shè)計(jì)帶來(lái)很大的方便。FPGA的設(shè)計(jì)則采用原理圖的輸入形式（也可以采用VHDL編程的輸入方式）。利用XILINX公司的Foundation Series實(shí)現(xiàn)FPGA的配制。

3.1 單軸運(yùn)動(dòng)控制策略的設(shè)計(jì)

3.1.1 位置與速度環(huán)控制策略的設(shè)計(jì)

位置與速度控制器采用PID控制，其輸出可表示為：

其中，!ref為加速度的參考值。根據(jù)上式得單軸永磁BLDC電機(jī)運(yùn)動(dòng)控制器的結(jié)構(gòu)圖如圖7所示。

3.1.2 電流環(huán)控制策略的設(shè)計(jì)

電流內(nèi)環(huán)采用PI控制器。PI控制器在s域內(nèi)可表示為：

其中，Y表示PWM電壓。X表示電流偏差。

其相應(yīng)的差分方程為：

3.2 運(yùn)動(dòng)控制系統(tǒng)的用戶界面設(shè)計(jì)

采用VC++6.0設(shè)計(jì)人機(jī)用戶界面，該用戶界面主要完成任務(wù)大致分為如下幾類：

（1）運(yùn)動(dòng)控制系統(tǒng)參數(shù)的修改：包括PMSM參數(shù)、負(fù)載的參數(shù)以及控制參數(shù)的修改；

（2）系統(tǒng)狀態(tài)量（位置、速度、加速度、電流等）的測(cè)量以及響應(yīng)曲線；

（3）極限參數(shù)的設(shè)定：最大電流、最大轉(zhuǎn)速、最大加速度等的設(shè)定；

（4）編碼器及HALL元件信息的設(shè)定和測(cè)量；

（5）運(yùn)行控制等；

（6）故障診斷。

3.3 運(yùn)動(dòng)控制系統(tǒng)軟件的基本設(shè)計(jì)思想

控制系統(tǒng)的主要運(yùn)行軟件主要包括二個(gè)模塊：初始化模塊和中斷模塊?，F(xiàn)分別介紹如下：

3.3.1 初始化模塊的設(shè)計(jì)

DSP復(fù)位后，初始化模塊執(zhí)行下列任務(wù)：

DSP設(shè)置：內(nèi)核設(shè)置，看門(mén)狗，各類時(shí)鐘程序，通用I/O程序，事件管理程序；

（1）變量初始化：主要是缺省變量的初始化；

（2）中斷服務(wù)程序的選擇和使能；

（3）循環(huán)等待：循環(huán)等待涉及到DSP和PC機(jī)人機(jī)界面的通訊。而DSP和PC機(jī)的通訊具體實(shí)現(xiàn)是借助于單片機(jī)PIC16C69的橋梁作用來(lái)完成的，即通過(guò)PC機(jī)的串行口（COM）和PIC的串口實(shí)現(xiàn)人機(jī)界面與DSP用戶板的通訊，確保用戶通過(guò)RS232連接更新變量及標(biāo)志。然后利用DSP的并行異步通訊口實(shí)現(xiàn)與PIC的并口通訊，確保由PC機(jī)人機(jī)界面下載修改參數(shù)時(shí)，不影響DSP主程序的執(zhí)行。

3.3.2 接口模塊的設(shè)計(jì)

接口模塊是低級(jí)程序，它將現(xiàn)實(shí)數(shù)據(jù)變換為適當(dāng)?shù)臄?shù)據(jù)形式。這些模塊包括：

（1）電流檢測(cè)和定標(biāo)；

（2）機(jī)械位置的檢測(cè)和定標(biāo)；

（3）電氣位置的定標(biāo)和機(jī)械速度的計(jì)算與定標(biāo)。

（4）控制策略設(shè)計(jì)模塊

鑒于篇幅，本文就不再贅述。

4 樣機(jī)的實(shí)驗(yàn)結(jié)果與討論

圖8～圖12分別給出了該裝置的實(shí)驗(yàn)結(jié)果。圖8給出了正、反轉(zhuǎn)運(yùn)行時(shí)平均電樞電流的給定值與實(shí)際值隨時(shí)間的變化曲線。圖9、圖10分別為單軸重復(fù)運(yùn)動(dòng)和階躍響應(yīng)時(shí)的位置偏差曲線。圖11分別為單軸運(yùn)動(dòng)時(shí)位置階躍響應(yīng)時(shí)的響應(yīng)曲線。圖12為BLDC電機(jī)的階躍響應(yīng)曲線比較。

經(jīng)過(guò)反復(fù)實(shí)驗(yàn)證明：本運(yùn)動(dòng)系統(tǒng)具有較好的性能，其最大速度為125，000 Counts/s（即最高轉(zhuǎn)速為7500r/m），其最大加速度為4，000，000 Counts/s2（即最大加速度為4000r/s2）。考慮到絲杠的螺距為3.6mm/r，故系統(tǒng)的最大速度為400mm/s，最大加速度為14.4m/s2。上述實(shí)驗(yàn)結(jié)果很好地反映了所設(shè)計(jì)控制器的收斂性和系統(tǒng)良好的動(dòng)靜態(tài)性能。

5 結(jié)論

本文基于DSP和FPGA實(shí)現(xiàn)了一套三軸交流運(yùn)動(dòng)控制系統(tǒng)，并將該運(yùn)動(dòng)系統(tǒng)成功地應(yīng)用于視頻檢測(cè)機(jī)系統(tǒng)中。本章對(duì)該三軸運(yùn)動(dòng)系統(tǒng)從系統(tǒng)結(jié)構(gòu)、系統(tǒng)的硬件電路設(shè)計(jì)、系統(tǒng)的用戶界面到系統(tǒng)軟件的設(shè)計(jì)思想均作了詳細(xì)地闡述。本章的最后對(duì)實(shí)驗(yàn)裝置和實(shí)驗(yàn)結(jié)果進(jìn)行了介紹。實(shí)驗(yàn)結(jié)果很好地驗(yàn)證了所設(shè)計(jì)方案的有效性和可行性。

[1]J.Slotine,W.Li,Applied Non linear Control,Englewood Cliff,NJ Prentice Hall,1991

[2]D.M.Dawson,J.Hu,T.C.Burg,Nonlinear Control of Electric Machinery,Marcel Dekker,Inc.,1998

[3]Joachim Holtz,Pulse width modulation for Electronic Power Conversion,proceeding of IEEE,1994,82（8）:1194－1214

[4]劉錦波，張承慧，電機(jī)與拖動(dòng)[M].北京：清華大學(xué)出版社，2006.08

[5]John Chiasson,Modeling and high-performance control of electric machine,John Wiley&Sons,Inc.,2005

[6]R.Dybey,P.Agarwal,M.K.Vasantha,“FPGA based PMAC motor control for system-on-chip applications”,Proceeding of International Conference on Power Electronics Systems and Applications,pp:194－200,Nov2004