基于DSP的無刷直流電機伺服系統(tǒng)設計
摘要:設計了以TMS320F2812DSP芯片為核心的無刷直流電機伺服控制系統(tǒng)。采用電流環(huán),速度環(huán),位置環(huán)三閉環(huán)控制,對位置環(huán)采用積分分離的PID算法,以減小電機在運行過程中積分校正對系統(tǒng)動態(tài)性能的影響。為加快系統(tǒng)響應速度,減輕DSP負擔,電流環(huán)采用模擬方法實現(xiàn)。實際應用表明該系統(tǒng)具有精度高,響應快,穩(wěn)定性好等優(yōu)點。
關鍵詞:伺服系統(tǒng);TMS320F2812DSP;三閉環(huán)控制;PID算法
O 引言
無刷直流電機(簡稱BLDCM)是一種用電子換向器取代機械電刷和機械換向器的新型直流電動機,具有結構簡單,調速性好,效率高等優(yōu)點,目前已經(jīng)得到廣泛應用。TMS320F2812數(shù)字信號處理器是TI公司最新推出的32位定點DSP控制器,器件上集成了多種先進的外設,具有靈活可靠的控制和通信模塊,完全可以實現(xiàn)電機系統(tǒng)的控制和通信功能,為電機伺服系統(tǒng)的實現(xiàn)提供了良好的平臺。本文設計了以高性能TMS-320F2812DSP芯片為核心的無刷直流電機伺服控制系統(tǒng)。
1 伺服控制系統(tǒng)硬件構成及其工作原理
系統(tǒng)硬件框圖如圖1所示。
1.1 控制電路
控制電路是以F2812為核心,另外還包括位置編碼、數(shù)據(jù)采集、數(shù)據(jù)通信等功能模塊和部分外圍電路及數(shù)據(jù)接口,其主要功能是實現(xiàn)對被控對象位置信息的采集和處理,速度反饋信息的接收和處理,位置、速度的閉環(huán)控制。F2812片內具有12位的AD轉換器,但為提高伺服系統(tǒng)運動的精度,在DSP外圍擴展了兩片6路16位的AD轉換芯片,用來采集反饋信號以及輸入的運動指令信號。
系統(tǒng)設計同時采用DSP和CPLD以提高電路的可行性。DSP所起到的作用主要是根據(jù)反饋的位置,速度信號,結合電機的運動方向和運動速度,利用F2812片上的電機控制專用外設EVA,通過數(shù)字I/O口輸出1路與電機運動相對應的PWM波。CPLD根據(jù)輸入的PWM信號,控制信號和數(shù)字信號組成的換相時序信息輸出對應大小和對應時序的相電壓,從而驅動電機做相應的運動。
1.2 信號采集以及調理電路
該電路對各種傳感器信號及電流電壓信號進行采集并處理。包括采樣的電流電壓反饋信號,給定的控制信號等模擬量信號,以及霍爾傳感器的輸出等開關量信號,經(jīng)調理電路處理后,使其幅值及電平可以滿足DSP控制器的要求。
本系統(tǒng)使用AD7656對采集來的模擬信號進行模數(shù)轉換。F2812的GPIOA0口與74ACl6373的使能端相連,用于使能鎖存器,GPIOAl與CONVSTX相連,用來啟動6路A/D的同時轉換。GPIOA2連接BUSY信號,AD7656轉換結束后,BUSY信號變低,DSP以查詢方式接收AD數(shù)據(jù)。74ACl6373用于鎖存AD轉換后的16位數(shù)據(jù),74LSl38用于將DSP地址線譯碼與AD7656的片選信號相連。[!--empirenews.page--]
1.3 驅動電路
電機的驅動電路由驅動芯片IR2130和三相全逆變電路構成。功率驅動電路采用+15 V供電,驅動芯片IR2130內置了2.5 μs的死區(qū)時間,防止統(tǒng)一橋臂的上下兩個MOSFET同時導通。當系統(tǒng)出現(xiàn)欠壓,過流時,IR2130啟動內置的保護電路鎖住后面的PWM輸出,保護系統(tǒng)電路。IR2-130的輸入信號是由CPLD解算而得的6路PWM波,經(jīng)過光耦隔離后送入IR2130,輸出信號送MOSFET驅動無刷直流電機。在三相逆變電路中,六個功率器件起繞組開關作用,采用兩兩通電,三相六狀態(tài)方式,每一個瞬間有兩個功率管導通,每隔1/6周期(60°電角度)換相一次,每次換相一個功率管,每個功率管一次導通120°電角度。
2 伺服系統(tǒng)的控制策略
本系統(tǒng)是通過電流、速度、位置三閉環(huán)結構實現(xiàn)系統(tǒng)控制的,其中電流環(huán)和速度環(huán)是內環(huán),位置環(huán)是外環(huán)。
圖2是無刷直流電機控制系統(tǒng)框圖,在系統(tǒng)中設置了速度PI調節(jié)器和電流PI調節(jié)器,分別調節(jié)電機的轉速和電流,兩者之間是串級連接。給定的位置信號U與反饋的位置信號position經(jīng)過位置PID調節(jié)后得到速度的參考值SDref。根據(jù)兩次捕獲的時間可以計算出電機運行的速度speed,此速度作為速度參考值的反饋量,經(jīng)過速度PI調節(jié)后可以得到參考電流Iref,通過電流檢測電路可以得到電流的反饋量I,再經(jīng)過電流PI調節(jié),最后得到的調節(jié)量用來控制PWM的占空比,即把速度調節(jié)器的輸出當做電流調節(jié)器的輸入,再以電流調節(jié)器的輸出去控制PWM裝置。
2.1 電流環(huán)控制
電流環(huán)是通過電流反饋控制使電機電樞電流線性受控,可達到電機輸出力矩的線性控制,并使其動態(tài)范圍響應快,安全性提高。
在實際應用中,為加快系統(tǒng)響應速度,減輕DSP負擔,采用模擬實現(xiàn)方法。將電阻串聯(lián)在電樞回路上,同時起到一個功率變換電路的過電流保護作用。通過電流反饋控制使電機電樞電流線性受控,可達到電機輸出力矩的線性控制,并使其動態(tài)范圍響應快,安全性提高。
電流環(huán)設計中,電流調節(jié)器選用PI調節(jié)器;限幅器可以和電流調節(jié)器做在一起,限幅值由PWM功放輸入范圍確定;PWM功放選用專用集成電路;濾波保護網(wǎng)絡采用LC網(wǎng)絡提高EMC水平,二極管網(wǎng)絡保護PWM功放選;電流調節(jié)器選用PI調節(jié)器;采樣電阻選用O.1Ω,如果所選PWM功放具有電流測量端子,也可以直接讀出電機電流值。
圖3為電流環(huán)控制框圖,R-電機電樞電阻,Tm-電機時常數(shù)。Ks-功率放大器電壓放大系數(shù)。電流環(huán)設計的參數(shù):PI調節(jié)器,一階無靜差;輸出最大電流≥0.63 A,反饋系數(shù)為15.873;帶寬≥30 Hz;τi選為電機等效時常數(shù)。
2.2 速度環(huán)控制
速度環(huán)是位置環(huán)的重要內環(huán)路,速度閉環(huán)可改善控制對象的線性度,提高速度控制精度,改善電網(wǎng)電壓等對電機轉速的影響,提高抗干擾能力,改善系統(tǒng)性能。
轉子旋轉一周的時間內,霍爾傳感器輸出3路180°的交疊信號,電動機每轉動60°就有一次換相,只要檢測兩次換相的時間間隔就能計算出電機的速度。[!--empirenews.page--]
2.3 位置環(huán)控制
位置環(huán)是通過安裝在電機轉軸上的電位器實現(xiàn)閉環(huán)的控制環(huán)路,位置環(huán)路的控制對象是電流環(huán)和傳動機構。由電位器測得的電壓信號經(jīng)過信號解調和AD轉換得到位置反饋信號。由于位置環(huán)具有很大的不確定性,加之被控對象的非線性以及系統(tǒng)參數(shù)的時變性等,為了減小電機在運行過程中積分校正對系統(tǒng)動態(tài)性能的影響,本系統(tǒng)對位置環(huán)采用積分分離的PID算法。如圖4所示,積分分離法是在誤差量較大時,不進行積分,直至誤差達到一定值之后,才在控制量的計算中加入積分累積。算法為:
3 系統(tǒng)軟件實現(xiàn)
伺服控制系統(tǒng)的軟件采用模塊化設計,使軟件組織靈活有序,便于調整、修改和移植。DSP程序主要由主程序,信號采集與輸出程序,PID算法程序,串口通信程序,濾波程序等組成。主程序首先是DSP的初始化,包括設置系統(tǒng)時鐘、定時器、系統(tǒng)狀態(tài)寄存器、設置IO端口。然后初始化中斷設置,確定系統(tǒng)所需要用到的中斷類別及中斷子程序,再設置事件管理器,產生PWM波。圖5為積分分離的PID程序流程圖,用積分分離的改進算法效果較好,程序簡單。
4 結束語
本文設計了一種基于TMS320F2812DSP的無刷直流電機伺服控制系統(tǒng),采用積分分離的PID控制算法,根據(jù)偏差,對不同情況進行不同的PID控制,并對系統(tǒng)的硬件設計以及控制算法進行了研究。試驗結果表明,系統(tǒng)響應快,性能穩(wěn)定,能較好的滿足伺服系統(tǒng)的控制性能要求。