◎尤向陽
(三門峽職業(yè)技術(shù)學(xué)院 電氣工程學(xué)院,河南 三門峽 472000)
超聲波電機是一種新型微特電機,在工業(yè)控制系統(tǒng)、辦公自動化、精密儀表等領(lǐng)域有廣泛的應(yīng)用[1]。超聲波電機由于改變了電磁效應(yīng)獲得轉(zhuǎn)速和轉(zhuǎn)矩的普通電動機原理,具有響應(yīng)速度快、低速大轉(zhuǎn)矩、無磁性、結(jié)構(gòu)簡單、體積小巧等特點,恰好滿足了黃金礦山井下巡檢機器人仿生關(guān)節(jié)的柔性要求,在礦山井下巡檢機器人仿生關(guān)節(jié)的驅(qū)動領(lǐng)域?qū)袕V闊的應(yīng)用前景[2]。由于超聲波電機不通過電磁作用產(chǎn)生運動力而是靠施加在定子上的正弦交流電壓來激勵,其轉(zhuǎn)子的旋轉(zhuǎn)速度與激振頻率、激振電壓以及兩相激振信號間的相位差存在很復(fù)雜的關(guān)系[3]。本文針對井下巡檢機器人仿生關(guān)節(jié)用超聲電機驅(qū)動及控制系統(tǒng),對超聲電機的開環(huán)與閉環(huán)調(diào)速特性進(jìn)行了實驗研究,記錄了相關(guān)實驗數(shù)據(jù)與波形,分析了超聲波電機的速度控制特性。
行波型超聲波電機驅(qū)動控制系統(tǒng)的實驗電路包括:以DSP56F801為核心的控制部分、4個電力MOSFET管和2個變壓器構(gòu)成的雙推挽逆變電路、頻率跟蹤電路、速度檢測電路、直流調(diào)壓電源和超聲波電機。驅(qū)動控制系統(tǒng)結(jié)構(gòu)框圖如圖1所示。
圖1 超聲波電機驅(qū)動與控制系統(tǒng)硬件結(jié)構(gòu)框架
其中逆變主回路利用開關(guān)電源技術(shù),通過開關(guān)組件的時序通斷,將直流12V電壓經(jīng)雙推挽電路逆變?yōu)槌暡姍C所需的49-55KHz的交流電壓,實現(xiàn)電機驅(qū)動;控制電路以DSP56F801為核心,是產(chǎn)生決定主電路中開關(guān)組件開關(guān)的PWM控制信號,電機輸入驅(qū)動電壓的工作頻率、電壓大小、相位差也由此電路控制。為能更好地控制超聲波電機的動態(tài)特性,除主回路外,還設(shè)置了反饋回路對電機進(jìn)行閉環(huán)控制;反饋回路作用是通過孤極電壓反饋大小,判斷電機是否漂移諧振頻率,從而改變PWM控制信號,使電機重新在諧振頻率下運行。反饋回路還設(shè)有光電編碼盤測速電路,通過碼盤輸出的ENA、ENB、ENZ信號連接DSP模塊中的TMRD定時器/計數(shù)器模塊,經(jīng)程序算法計算電機轉(zhuǎn)速及轉(zhuǎn)向。硬件電路的電源由直流穩(wěn)壓電源提供。
本實驗以行波型超聲波電機為研究對象,它的諧振頻率約為50KHz。直流穩(wěn)壓電源提供DC12V電壓經(jīng)雙推挽電路逆變后接入超聲波電機的兩相輸入端??刂齐娐樊a(chǎn)生頻率、占空比、相位差可調(diào)的PWM信號,通過放大、隔離電路驅(qū)動雙推挽電路,實現(xiàn)對超聲波電機的驅(qū)動控制。
DSP56F801的PWM模塊主要用于電機控制,控制電路利用DSP56F801的PWM模塊對超聲波電機供電電壓的頻率、占空比、相位差的實時調(diào)整,實現(xiàn)超聲波電機的速度控制[4]。通過實時配置模塊中各寄存器的值,產(chǎn)生所需PWM信號。PWM模塊有6個輸出通道,從PWM0-PWM5,課題研究中用到PWM0-PWM3,將其配置為兩對互補通道對;將PWM4、PWM5屏蔽,即通道占空比為0%。在控制方法上,先進(jìn)行開環(huán)試驗,再進(jìn)行閉環(huán)試驗。閉環(huán)控制通過實時檢測孤極反饋電壓大小,改變驅(qū)動信號頻率來實現(xiàn)頻率跟蹤閉環(huán)控制。
在傳統(tǒng)電機變頻驅(qū)動系統(tǒng)中,為避免逆變器上、下橋臂直通,PWM信號中需要加入一定寬度的死區(qū)[5-6]。對于DSP56F801內(nèi)置PWM模塊而言,只需設(shè)定死區(qū)寬度寄存器和其他幾個標(biāo)志位,在生成PWM信號時,指定寬度的死區(qū)就會自動加入,從而改變輸出PWM信號的占空比。死區(qū)時間的加入,使得一組互補PWM信號的脈沖寬度都減少了相同值。適當(dāng)利用死區(qū)時間,可以生成適合推挽式驅(qū)動電路工作的對稱PWM信號。通過對PWM模塊中各寄存器適當(dāng)賦值,使PWM發(fā)生器工作,并在每半周期重載中斷程序中載入不同的值,實現(xiàn)頻率、占空比、相位差的實時調(diào)整,實現(xiàn)超聲波電機的速度控制。
由于超聲波電機的運行特性與驅(qū)動PWM信號的頻率、占空比及相位差有關(guān),在測試過程中為了獲取PWM信號對超聲波電機動態(tài)特性的影響情況,采取固定其中兩個變量,調(diào)節(jié)第三個變量的方式進(jìn)行測試,其具體實驗過程為:首先固定占空比為16%,相位差為90°,調(diào)節(jié)頻率,記錄PWM信號波形、電機輸入端電壓、反饋端電壓及電機轉(zhuǎn)速。其次固定相位差為90°,頻率為50KHz,調(diào)節(jié)占空比用以調(diào)節(jié)電壓,進(jìn)行相關(guān)記錄。最后固定占空比為0.16,頻率為50KHz,調(diào)節(jié)相位差,進(jìn)行相關(guān)記錄。
圖2是兩路PWM信號PWM0和PWM2,圖3是USM輸入端的電壓波形。由測試實驗數(shù)據(jù)可知,在諧振頻率50KHz附近,隨著PWM信號頻率的增加USM電機輸入電壓有效值Vrms和峰值電壓Vmax逐漸增加,反饋電壓有效值Vrms和峰值電壓Vmax同時減少,同時電機速度明顯降低。當(dāng)PWM信號頻率為50KHz、相位差為90°,占空比由10%逐漸增大時,電機輸入有效值Vrms和峰值電壓Vmax變化不大,反饋電壓有效值Vrms和峰值電壓Vmax也變化不大,電機轉(zhuǎn)速變化不明顯,可見對任一驅(qū)動頻率,調(diào)壓控制所能獲得的調(diào)速范圍非常有限。當(dāng)PWM信號頻率為50KHZ、占空比為16%,相位差在[90°,-90°]變化時;隨著相位差的逐漸減小,電機轉(zhuǎn)速逐漸降低,但不明顯;相位差為54.3°時,電機轉(zhuǎn)速突然明顯降低;相位差為[18.7°,-18.7°]時,為控制死區(qū),電機停轉(zhuǎn);隨著相位差絕對值的增大,電機開始反轉(zhuǎn),當(dāng)相位差為-90°時,電機反轉(zhuǎn)速度最大。
圖2 PWM模塊輸出信號
圖3 USM輸入端的電壓波形
在驅(qū)動信號固定頻率、占空比、相位差的情況下,電機轉(zhuǎn)速隨時間增加越來越慢。其原因是超聲波電機旋轉(zhuǎn),定轉(zhuǎn)子間摩擦生熱,定子諧振頻率下降,而驅(qū)動頻率不變將導(dǎo)致兩者不匹配,電機難以諧振,故轉(zhuǎn)速下降。為使電機轉(zhuǎn)速穩(wěn)定運行,須對超聲波電機進(jìn)行閉環(huán)控制。
由開環(huán)控制時電機的運行特性可知,電機轉(zhuǎn)速隨時間變化而逐漸降低,是由于諧振頻率發(fā)生漂移,為維持電機轉(zhuǎn)速穩(wěn)定,須加入頻率跟蹤閉環(huán)控制。本文通過實時檢測孤極反饋電壓大小,改變驅(qū)動信號頻率來實現(xiàn)頻率跟蹤。
圖4為頻率跟蹤時轉(zhuǎn)速曲線及孤極反饋電壓曲線,實驗時將諧振時反饋電壓的采樣參考值置為1500,開始的PWM信號的頻率置為51.24KHz,相位差為90°,占空比為16%,從圖中可以看出,在18秒之前,孤極反饋電壓采樣值一直小于1500,程序運行時不斷增加PWMCM計數(shù)模寄存器中的值,使輸出的PWM信號的頻率值逐漸減小,使電機轉(zhuǎn)速逐漸增加;在18秒后,孤極反饋電壓采樣值開始大于1500,這時驅(qū)動頻率以達(dá)諧振頻率50KHz,隨著電機的轉(zhuǎn)動,電機升溫,諧振頻率開始漂移,電機轉(zhuǎn)速開始下降,孤極反饋電壓采樣值也逐漸減小,當(dāng)小于1500時,又再次增加PWMCM計數(shù)模寄存器中的值,減小PWM信號的頻率,如此周而復(fù)始,實現(xiàn)了諧振頻率的自動跟蹤。
由于DSP56F801芯片系統(tǒng)時鐘限制,驅(qū)動信號頻率無法連續(xù)調(diào)節(jié),使電機轉(zhuǎn)速波動較大,為使電機具有更好的動、靜態(tài)性能,本文采用基于頻率跟蹤的電壓PID調(diào)節(jié)。圖5為基于頻率跟蹤的電壓PID調(diào)節(jié)后的速度曲線。曲線表明,電機轉(zhuǎn)速穩(wěn)定性有所提高,但仍沒特別穩(wěn)定。究其原因,主要由于轉(zhuǎn)子預(yù)緊力不一致和壓電元件機電性能的均勻度不一,且轉(zhuǎn)速與PWM信號占空比非線性。以上原因,都會造成兩片壓電陶瓷的工作頻率不一致,振幅有差別,而反饋回來的僅為一片檢測壓電陶瓷的電壓信號,反饋量上存在一定誤差。因此,要提高電機的運行性能還要從壓電材料、電機本體結(jié)構(gòu)、加工工藝等多方面進(jìn)行改善。
圖4 轉(zhuǎn)速曲線與孤極反饋電壓曲線
圖5 基于頻率跟蹤電壓PID速度控制曲線
基于DSP的驅(qū)動控制器及其軟件實現(xiàn)都是超聲波電機研究的重要環(huán)節(jié),它們的性能好壞直接影響電機的性能。本實驗在基于DSP56F801的驅(qū)動控制系統(tǒng)硬件電路的基礎(chǔ)上進(jìn)行,對超聲波電機的調(diào)速特性進(jìn)行了實驗,記錄相關(guān)實驗數(shù)據(jù)、波形。通過對試驗數(shù)據(jù)分析,得到了超聲波電機在不同激勵頻率、占空比、相位差的PWM信號作用下的開環(huán)調(diào)速特性以及在頻率自動跟蹤、基于頻率跟蹤的電壓PID控制這兩種控制方式下的閉環(huán)調(diào)速特性。實驗結(jié)果表明基于DSP的驅(qū)動控制系統(tǒng)實現(xiàn)簡單,數(shù)字化程度較高。開環(huán)狀態(tài)下電機隨著運行時間的增加轉(zhuǎn)速大幅下降;頻率跟蹤狀態(tài)下,電機的轉(zhuǎn)速較開環(huán)時,有較大提高,但仍波動較大;基于頻率跟蹤的電壓PID控制狀態(tài)下,電機的轉(zhuǎn)速較平穩(wěn)。基于DSP的頻率跟蹤配合電壓PID控制策略改善了超聲波電機的運動控制性能。今后,可在此基礎(chǔ)上,充分利用DSP運算能力強、集成度高的優(yōu)勢,研究適當(dāng)?shù)目刂扑惴?,進(jìn)一步提高控制性能。