基于現場可編程門陣列的超聲電磁復合電機驅動控制系統設計*

羌予踐，華 亮， 張汝建，林 純

(南通大學電氣工程學院，江蘇南通 226019)

0 引言

以提高電機定位精度及改善電機運行性能為目的的細分驅動技術能使步進電機達到很高的定位精度，但細分數越大，精度越難控制［1］。現實工況下，如焊接過程中的高頻起弧和穩弧對驅動電路存在很嚴重的高頻電磁波干擾，采用步進電機細分電路會大大降低系統的可靠性和穩定性，驅動器要滿足相當高的技術要求和工藝要求，成本也會較高［1］。超聲波電機(Ultrasonic Motor，USM)是一種非電磁電機，由于其具有轉速低、轉矩大、定位精度高、功率密度大、無電磁干擾等優越特性，所以得到廣泛應用。但長時間工作會導致電機材料特性和輸出特性變化，產生諧振頻率漂移、轉速下降。由于依靠摩擦傳遞力矩，因此USM的壽命一般都不長，如日本Shinsei公司生產，并得到廣泛應用的行波USM USR30和USR60壽命分別為2 000 h和1 000 h。

近年來國內、外學者采用電磁伺服電機作為定位系統粗定位驅動元件，采用USM或壓電制動器作為定位系統精密定位驅動元件，充分結合了USM與電磁電機各自的優點，取得了較好的效果［2-4］。本文設計了基于現場可編程門陣列(Field Programmable Gata Array，FPGA)的超聲電磁混合電機驅動控制系統，充分采用FPGA集成度高、抗干擾能力強、升級維護方便等特點，將USM及步進電機控制信號源均集成于FPGA，有助于超聲電磁混合系統的小型化、集成化、高效化設計，有助于系統整體性能的提高。

1 驅動控制系統的整體設計

基于單片機和FPGA的混合電機控制系統如圖1所示。該驅動控制系統由以單片機為核心的控制單元、以FPGA為核心的執行單元、以電力電子器件為核心的驅動單元三部分組成。單片機把速度、轉向、運行步數等控制信息寫入FPGA，由FPGA產生電機實際的驅動信號。單片機可專注于信號處理和運算，不必占用過多的CPU資源去直接控制電機，也減小了由此引入干擾的可能性。單片機和FPGA間通過I/O口線進行通信，FPGA的擴展使系統集成度高、維護升級便利。

圖1 驅動控制系統總體原理圖

2 基于FPGA的行波USM驅動控制系統設計

2.1 設計要求

USM對其外加驅動信號的頻率、幅值均有特定的要求。本文采用兩相相位差為90°的高頻正弦電壓信號驅動行波USM，信號頻率、相位可調，頻率大小由壓控振蕩器調節。本文分析的驅動控制器具有電機正、反轉控制功能，并采用速度閉環控制及頻率自動跟蹤電路以補償電機諧振點變化或負載變化造成的參數變化。

2.2 驅動信號源設計

2.2.1 系統總體設計

該移相信號發生器原理框圖如圖2所示。移相信號發生器［5］由相位字寄存器、相位累加器、波形存儲器、相位加法器、數模轉換器及低通濾波器組成。其中時鐘信號由壓控振蕩器產生，圖2中的N位字長的二進制加法器和N位累加寄存器是驅動源的核心，其作用是對內置為1的頻率字進行累加。

圖2 數字移相正弦信號發生器原理框圖

每來1個時鐘脈沖，N位加法器將內置頻率控制字數據與累加寄存器輸出的累積相位數據相加，把相加后的結果送至累加寄存器的數據輸入端。累加寄存器一方面將加法器在上一次相加后所產生的新相位數據反饋到加法器的輸入端，另一方面將其輸出的地址分成兩路，一路直接從波形存儲器中取出波形幅度數據，經D/A轉換器和低通濾波器將波形數據轉換成參考信號，另一路通過相位加法器加上移相控制字，形成移相信號的地址碼，從波形存儲器中取出波形數據，最后經D/A轉換器和低通濾波器將波形數據轉換成移相正弦波信號。當相位累加器累積滿量時就會產生1次溢出，完成1個周期性的動作，這個周期就是合成信號的1個周期。

2.2.2 系統的FPGA設計

基于FPGA的信號源產生電路如圖3所示。

(1)相位累加器。圖3中SUM模塊為相位累加器，相位累加器的累加值內置為1，當時鐘上升沿到來時累加一次，累加至255時，當下一時鐘上升沿到來時，相位累加器就會溢出完成一個周 期的累加。SUM模塊時序仿真圖如圖4所示。

圖3 基于FPGA的信號源產生電路

圖4 SUM模塊時序仿真圖

(2)相位加法器。圖3中的SUM2模塊為相位加法器，相位加法器完成將數據地址轉換為信號間的相位差值。當時鐘上升沿到來時，如果ZF=1，相位加法器將相位累加器的地址值加上移相控制字，如果ZF=0，相位加法器將相位累加器的地址值減去移相控制字，產生一超前或滯后的偏移地址值，從而控制電機的正反轉。相位加法器時序仿真圖如圖5所示。

(3)波形存儲器及整體電路仿真。使用LPM模塊中只讀存儲器lpm_rom，把正弦波形離散數據儲存在ROM中，使用累加地址訪問存儲器。由于后續D/A轉換精度為8位，因此lpm_rom中輸出數據位數LPM_WIDTH置為8位。此外，地址線寬度置為8位，地址輸入由時鐘上升沿觸發，輸出為寄存器方式。

對整體電路進行編譯仿真，結果如圖6、圖7所示。

2.2.3 信號源的實現

FPGA輸出數字量信號依次經8位D/A轉換器及濾波器(由二階濾波器與一階濾波器級聯構成)后，得到的超聲波電路驅動波形如圖8所示。

圖5 相位加法器時序仿真圖

圖6 系統正轉仿真波形圖

圖7 系統反轉仿真波形

圖8 行波USM驅動電路波形

2.2.4 功放電路及頻率閉環控制電路

設計中采用基于甲乙類單電源互補對稱放大電路技術的功率放大電路作為驅動電路。設計的頻率跟蹤電路中，Uin為設定電壓，它與反饋直流電壓Uf在電壓比較器中進行比較，輸出信號輸入單片機，控制單片機內計數器加或者減計數，計數器用軟件方式實現。計數值輸出到D/AC0832改變輸出直流電壓的值，它與加法電路的預置電壓Uco一起作為VCO輸入電壓，控制VCO輸出實現頻率自動跟蹤。

圖9 頻率跟蹤器設計框圖

3 基于FPGA的三相磁阻式步進電機驅動控制系統設計

步進電機是在脈沖分配器的控制下進行各種運動動作的。脈沖分配器的輸出頻率控制步進電機的速度，而脈沖的分配順序控制步進電機的正反轉。脈沖分配器的控制電路邏輯圖如圖10所示。

整個電路由分頻器和相序分配器構成。時鐘信號CLK(12 MHz)經過分頻器分頻后作為相序分配器的時鐘信號，a為轉向控制端，a為1時正轉，a為0時反轉。b，c為工作方式選擇端，輸出不同的相序波形，控制步進電機的動作。A，B，C為三相脈沖輸出端。分頻器和相序控制器由硬件描述語言VHDL來編寫。

圖11中，PULSE分頻器模塊將系統時鐘12 MHz進行60分頻，得到200 kHz的方波信號輸給調頻器SUM。調頻器SUM單元由N位累加器為核心組成，累加器將頻率控制字K進行累加，把相加后的結果的最高位輸出。當相位加法器滿時會產生一次溢出，這樣就完成了一個周期。調頻器 SUM的基準時鐘為 200 kHz，累加器13位，K為8位，頻率輸出范圍為

圖11 基于FPGA的環形脈沖分配器設計

脈沖分配器用有限狀態機來實現［7］。步進電機運行方式由控制信號zf，mos1，mos2來選擇，信號zf控制電機的正反轉，mos1，mos2選擇電機的運行模式。整體電路仿真結果如圖12所示，示波器采集的波形如圖13所示。

圖12 整體電路仿真波形

圖13 示波器采集波形

4 結語

USM一般有效工作時間少于2 000 h，使USM在連續運行的高精度控制系統中使用受到限制。因此，為真正使USM成為廣泛使用的高精度控制電機，須提高電機的有效工作時間。以超聲電磁混合電機為背景，設計了基于FPGA的一體化驅動控制系統，并進行了試驗研究。該系統采用FPGA作為超聲波電機與步進電機的信號發生源，并配合單片機實現了電磁超聲混合電機的驅動控制，為超聲電磁混合電機系統的小型化、集成化設計提供了基礎。

［1］華亮，吳曉，馮浩.新型混合直接驅動的機器人關節精密定位系統［J］.機電工程，2008，25(3):10-12.

［2］林海波，黃小良，楊國哲.三維微細電火花加工伺服控制系統設計及實驗研究［J］.機械設計與制造，2010，20(5):48-49.

［3］林長春.光學零件超精密磨削進給控制系統的研制［D］.長春:長春光學精密機械學院，2000.

［4］孫德旭.多功能微細加工數控平臺研究［D］.青島:中國石油大學，2007.

［5］王龍帥.基于DDS的超聲波電機驅動控制研究［D］.洛陽:河南科技大學，2009.

［6］施紀紅.基于VHDL語言設計的步進電機控制器［J］.蘇州市職業大學學報，2008，19(4):19-21.