覃曾攀,曾岳南,吳禮智
(廣東工業(yè)大學自動化學院,廣東廣州 510006)
隨著電力電子技術(shù)的發(fā)展、新材料的出現(xiàn)、微處理器水平的不斷提高和交流控制理論研究不斷地深入,永磁同步電機在航空航天、數(shù)控機床、加工制造、機器人等方面獲得了廣泛應(yīng)用。由于數(shù)字控制技術(shù)的發(fā)展,使得數(shù)字控制器在處理速度、抗干擾、系統(tǒng)穩(wěn)定性等方面都是模擬控制器無法比擬的[1-2]。近年來,基于FPGA 的電機控制得到越來越多的關(guān)注,它不僅實現(xiàn)了軟件需求和硬件設(shè)計的完美集合,還實現(xiàn)了高速與靈活性的完美結(jié)合,使其超越了ASIC器件的性能和規(guī)模,也超越了傳統(tǒng)意義上的FPGA的概念[3]。
本文研究了交流永磁同步電機矢量控制策略,PI 調(diào)節(jié)器,電流采樣,速度以及位置的測量,并通過硬件描述語言實現(xiàn)各個模塊的設(shè)計。整 個 系 統(tǒng) 的 設(shè) 計 是 利 用 Cyclone ⅢEP3C25Q240C8N 型FPGA 作為主控芯片,實現(xiàn)交流永磁同步電機的雙閉環(huán)控制。
永磁同步電機在同步旋轉(zhuǎn)坐標系中的電壓方程:

永磁同步電機電磁轉(zhuǎn)矩方程為:

Ld、Lq為電機直軸、交軸同步電感,Rs為電機定子電阻,Pn為電機定子繞組極對數(shù),ψf為轉(zhuǎn)子永磁體磁極的勵磁磁鏈,ω 為電機轉(zhuǎn)速,Te為電機電磁轉(zhuǎn)矩。對于表貼式永磁同步電機,在電機定子上接三相對稱正弦波電源,在旋轉(zhuǎn)坐標系中的變量都為直流變量,并且由轉(zhuǎn)矩方程式直接可以看出電機的輸出轉(zhuǎn)矩與電流iq呈線性關(guān)系,只需要控制iq的大小就可以控制電機的輸出轉(zhuǎn)矩。電機矢量控制結(jié)構(gòu)如圖1所示。

圖1 永磁同步電機矢量控制結(jié)構(gòu)圖
永磁同步電機矢量的基本思想是建立旋轉(zhuǎn)坐標變換對id、iq軸的解耦,最終實現(xiàn)了相似于直流電機轉(zhuǎn)矩的控制方法來控制永磁同步電機轉(zhuǎn)矩,獲得和直流電機相當?shù)男阅躘4]。圖2 為定子電流空間矢量示意圖,abc 為三相靜止坐標系,αβ為兩相靜止坐標系,dq 為兩相旋轉(zhuǎn)坐標系。定義電流空間矢量is為:

圖2 定子電流空間矢量圖

由三相靜止坐標系到兩相靜止坐標系(Clark變換)可得:

再由兩相靜止坐標系到兩相旋轉(zhuǎn)坐標系(Park變換)可得:

相應(yīng)的從兩相旋轉(zhuǎn)坐標系到兩相靜止坐標系(Park-1變換)可表示為:

其中θ 為轉(zhuǎn)子角位置。當采用id=0的控制方式時,定子電流矢量is落在q 軸上,這時轉(zhuǎn)矩方程為:
Te=1.5Pnψfiq
其中Pn為電機定子繞組極對數(shù),ψf為永磁磁鏈為恒值。從轉(zhuǎn)矩方程可以看出,通過坐標變換,永磁同步電機的電磁轉(zhuǎn)矩與電流iq成正比,控制iq就能直接控制電磁轉(zhuǎn)矩。其矢量控制結(jié)構(gòu)圖如圖1所示。
系統(tǒng)硬件邏輯結(jié)構(gòu)框圖為圖3 所示,其主要包括矢量變換模塊、SVPWM 調(diào)制模塊、電流采樣模塊、轉(zhuǎn)速測量模塊、位置檢測模塊、轉(zhuǎn)速和電流PI 調(diào)節(jié)模塊6 大部分。
矢量變換模塊包括clark、park、park 逆變換,而在park 和park 逆變換中存在正余弦的計算,而在數(shù)字信號處理中正余弦的計算一般有三種方法:查表法、泰勒級數(shù)法、CORDIC 算法[6]。從占用資源、精度兩方面考慮,因為CORDIC 算法在精度比較高的情況下所占用資源少,故采用CORDIC算法,其迭代公式為:


圖3 系統(tǒng)硬件邏輯結(jié)構(gòu)框圖

其中,當zi≥0 時,Si=1;否則,Si=-1。設(shè)k是一個無理常數(shù),其表達式為:

當n →∞時,k≈0.607 253。實驗采用有符號18 位的Q14 格式來表示[0,2 π]范圍的弧度值,從迭代公式可以看出,輸出結(jié)果同時完成了cos θ 和sin θ 的運算。其數(shù)字邏輯電路結(jié)構(gòu)框圖如圖4所示。

圖4 CORDIC算法數(shù)字邏輯電路結(jié)構(gòu)框圖
SVPWM調(diào)制模塊主要由扇區(qū)判斷、基本電壓矢量作用時間計算、電壓空間矢量切換點計算、載波生產(chǎn)模塊、PWM生成模塊,死區(qū)設(shè)置模塊等幾部分組成[7]。其數(shù)字邏輯電路結(jié)構(gòu)框圖如圖5所示。
系統(tǒng)采用2 個電壓型霍爾傳感器檢測兩相電流,再通過跟隨、濾波、放大、抬升將雙極性的電壓信號轉(zhuǎn)化為單極性的范圍在0至3V電壓之后經(jīng)過TLC549CP芯片進行模數(shù)轉(zhuǎn)換送入FPGA主芯片中,由于采用的AD轉(zhuǎn)換芯片在AD轉(zhuǎn)換后的數(shù)據(jù)是串行數(shù)據(jù),故在FPGA 中還必須進行串行到并行的轉(zhuǎn)換,而且之后還需轉(zhuǎn)化為雙極性實際電流的大小并進行標幺化,其數(shù)字邏輯電路結(jié)構(gòu)框圖如圖6 所示,其中虛線框圖中串并轉(zhuǎn)換模塊主要輸出AD芯片需要的片選信號和時鐘信號,其輸入為兩相電流AD轉(zhuǎn)換后的數(shù)字信號。

圖5 SVPWM調(diào)制模塊結(jié)構(gòu)框圖
轉(zhuǎn)速、位置檢測主要是通過復(fù)合式光電編碼器發(fā)出的A、B、Z、U、V、W 六路信號來計算,電機每轉(zhuǎn)一圈A、B 每相輸出2 500 個脈沖,電機逆時針旋轉(zhuǎn)A相超前B相90°,順時針旋轉(zhuǎn)時,B相超前A 相90°。電機每轉(zhuǎn)一圈輸出一個Z 脈沖,用于角度清零,消除累加誤差。U、V、W三相用于電機的初始定位。為提高測量轉(zhuǎn)速和位置的精確度將A、B脈沖4倍頻,故電機轉(zhuǎn)一圈可發(fā)出10 000 個脈沖,編碼器每發(fā)出一個脈沖電機旋轉(zhuǎn)0.288的電角度,這樣通過檢測脈沖個數(shù)就可以計算電機的位置。轉(zhuǎn)速測量采用位置差分方法,其數(shù)學表達式:

圖6 電流采樣模塊結(jié)構(gòu)圖

其中,w(k)為第k次采樣的角速度,θ(k)為第k 次采樣的電機角度,θ(k-1)為第k-1 次采樣的電機角度,T為采樣時間。
數(shù)字PI 調(diào)節(jié)器有位置式和增量式兩種算法,位置型PI調(diào)節(jié)器的計算需要進行累加,計算量較大,不便于程序的實現(xiàn),而且需要用到過去的誤差值,容易產(chǎn)生大的累加誤差;增量型PI調(diào)節(jié)器不需要做累加,控制量的確定僅與最近兩次的誤差值有關(guān),計算量少,計算精度更高[5]。故本文采用增量型PI調(diào)節(jié)器。
離散化后的PI表達式如下所示:

其中Kp為比例系數(shù),KI為積分系數(shù),Tsam為采樣周期。其數(shù)字邏輯結(jié)構(gòu)框圖如圖7所示。

圖7 PI調(diào)節(jié)器數(shù)字邏輯電路框圖
以上介紹的模塊都采用VHDL 語言編寫,并在FPGA(EP3C25Q240C8N)上實現(xiàn),系統(tǒng)編譯報告如表1 所示。本系統(tǒng)的測試電機額定功率為750 W,額定轉(zhuǎn)速為3 000 r/min,額定電流為3.58 A,光電編碼線數(shù)為2 500PPR,永磁同步電機。系統(tǒng)電流環(huán)的采樣頻率和IGBT的開關(guān)頻率采用10 kHz,開關(guān)死區(qū)時間為4 μs ,轉(zhuǎn)速環(huán)的采樣頻率為2.5 kHz。從SVPWM 輸出的上橋臂信號圖可以看出開關(guān)周期為100 μs ,圖8為V相和W相的電流波形,圖9 為電機開始啟動轉(zhuǎn)速給定指令為900 r/min 的動態(tài)響應(yīng)波形。實驗表明系統(tǒng)具有良好的動態(tài)響應(yīng)。

表1 編譯報告

圖8 V、W相電流波形圖
系統(tǒng)采用以FPGA 為控制芯片,根據(jù)矢量控制理論,SVPWM調(diào)制算法,id=0的控制策略實現(xiàn)了永磁同步電機的雙閉環(huán)調(diào)速。整個系統(tǒng)的設(shè)計以全硬件的方式實現(xiàn),使得電流環(huán)的響應(yīng)速度非常快,整個系統(tǒng)的動態(tài)響應(yīng)性能提高,保證了系統(tǒng)的實時性。同時系統(tǒng)設(shè)計采用Altera公司的Cyclone ⅢEP3C25Q240C8N型具有豐富的邏輯資源和應(yīng)用I/O,使得系統(tǒng)在提高控制精度和升級成為可能。

圖9 轉(zhuǎn)速波形圖
[1]Naizheng Cui,Cuijie Yang,Yajing Liu,and Pinzhi Zhao.Development of an FPGA-Based high performance Servo Drive System for PMSM [A].ISSCAA 2006,19-21.
[2]S.Carbone,V.Delli Colli.Design and Implementation of High performance FPGA Control for Permanent Magnet SynchronousMotor [A].IEEEINMIC,Nov.2009,2901-2906.
[3]Zhaoyong Zhou,Tiecai Li.FPGA Realization of a high-performance Servo Controller for PMSM [A].APEC 2004,Vol.3,1604-1609.
[4]Abdolreza Esmaeli,Li Bo,Sun Li.A novel AC Servo System Implementation [A].IEEE INMIC,Nov.2005,1-5.
[5]Qi Hui,Zhao Ya.Design and Realization of PMSM Vector Control IP Core Based on FPGA [A].IEEE INMIC,Nov.2006,1325-1328.
[6]Zhou Zhu.Implementation and Studies on Direct Digital Frequency Synthesis based on CORDIC Algorithm[M].National University of Defense Technology,December,2005.
[7]梁文軍,楊世錫,魏義敏.基于FPGA 的轉(zhuǎn)子振動信號整周期等相位采樣控制方法[J].機電工程,2011(2):148-152.
[8]Zhou Yuan,Xu Fei-peng,Zhou Zhao-yong.Realization of an FPGABased SVPWM Controller[A].IPEMC′06,Vol.1,Aug.2006,1-5.