基于TMS320F28335的雷達伺服系統(tǒng)的設計與實現(xiàn)
摘要:以為核心,設計了一種高可靠性的雷達伺服系統(tǒng)。描述了伺服系統(tǒng)的組成及其工作原理,重點討論了伺服控制器的設計,分析系統(tǒng)的安全控制策略,并給出具體實現(xiàn)的控制電路。實踐表明:系統(tǒng)具備精度高、穩(wěn)定性好、可靠性高、易調試等特點。
本文引用地址:http://2s4d.com/article/235827.htm關鍵詞:伺服系統(tǒng);控制器;TMS320F28335;安全控制策略
伺服系統(tǒng)是雷達的重要組成部分,其性能的好壞直接影響雷達的動態(tài)性能和測量精度,如何保證其高精度、安全、可靠工作是雷達伺服系統(tǒng)設計的關鍵,本文介紹了一種基于TMS320F28335的雷達伺服系統(tǒng)的工程設計與實現(xiàn)的方法。TMS320F28335是TI公司最新推出的控制專用32位浮點DSP芯片,它的機器周期最短只有約6ns,芯片內部集成了豐富的外設資源,具有很強的信號處理及控制能力,在電機控制應用方面具有獨到的優(yōu)勢。
1 系統(tǒng)組成及工作原理
該雷達伺服系統(tǒng)主要由控制器、驅動器、電機、編碼器、減速機構、電源及控保電路等部分組成,系統(tǒng)組成框圖如圖1所示。
?
?
其工作原理為伺服控制器接收到控制命令后,進入相應的工作模式,經過控制運算后輸出控制電壓到伺服驅動器,驅動伺服電機帶動轉臺按要求轉動。
伺服系統(tǒng)環(huán)路設計采用電流環(huán)、速度換、位置環(huán)三環(huán)控制方案。伺服控制器完成位置環(huán)閉環(huán)功能,伺服驅動器完成電流環(huán)和速度環(huán)的閉環(huán)功能。電流環(huán)和速度環(huán)為位置環(huán)的內環(huán),電流環(huán)設計為比例控制,速度環(huán)設計為比例積分控制,把設計好的電流環(huán)作為速度環(huán)的一個環(huán)節(jié)來設計。為了保證系統(tǒng)精度,位置環(huán)設計為Ⅱ型系統(tǒng),采用滑模變結構控制策略,以滿足系統(tǒng)的穩(wěn)定性和精度要求。系統(tǒng)環(huán)路原理框圖如圖2所示。
?
?
伺服電機選用交流伺服電機,交流伺服電機因體積小、轉動慣量小、過載能力強、控制簡單等特點,在高精度、高可靠性的伺服驅動領域應用廣泛。電機與轉臺方位軸和俯仰軸之間安裝減速器。系統(tǒng)位置檢測采用光電編碼器,根據(jù)系統(tǒng)精度的要求,采用16位的光電編碼器,其測角分辨率為。光電編碼器通過聯(lián)軸器安裝于方位和俯仰軸上。驅動部分采用全數(shù)字交流伺服驅動器,速度控制模式,伺服驅動器內部運動控制參數(shù)可在線調整,方便調試。
2 伺服控制器設計
伺服控制器以TMS320F28335為控制核心,加上一些必要的外圍電路構成。伺服控制器的功能是實現(xiàn)位置閉環(huán)控制、串口通信、信號檢測、故障檢測及安全保護等功能。
2.1 伺服控制器硬件組成
伺服控制器硬件電路主要由DSP主控芯片、DSP外圍電路、電源電路、D/A轉換電路、故障檢測電路、電平轉換電路、安全保護電路等構成,如圖3所示。系統(tǒng)外擴了512kx16位SRAM,方便系統(tǒng)調試時的外部仿真;采用AD7836外擴4路D/A輸出信號,其中兩路作為正向通道,兩路作為位前饋通道,經過控制運算后作為驅動器速度環(huán)路的輸入信號;利用TMS320F28335芯片自帶的3路SCI,經接口芯片MAX3491電平轉換后,將TTL電平信號轉換為RS422電平信號,實現(xiàn)伺服控制器與兩路編碼器及上位機的通信,所有輸入輸出的I/O信號均通過光耦與外部隔離,起到保護DSP內核的作用。
?
?
2.2 D/A轉換電路設計
系統(tǒng)要求的轉速范圍為0.05°/s~60°/s,則系統(tǒng)調速比
?
?
?
2.3 系統(tǒng)控制軟件設計
系統(tǒng)軟件在CCS3.3開發(fā)環(huán)境下用C語言編寫,采用模塊化方法設計,便于調試,系統(tǒng)軟件流程如圖5所示。其工作過程為:系統(tǒng)復位后首先對DSP進行初始化,然后系統(tǒng)自檢,如果自檢異常,系統(tǒng)進入保護模式,切斷伺服驅動器的SRV—ON信號。如果自檢正常,則系統(tǒng)根據(jù)上位機指令進入相應的工作模式,進行數(shù)據(jù)采集、信號處理及串口通信,最后,伺服控制器判斷是否系統(tǒng)有故障,如果無故障,則系統(tǒng)進入下一個循環(huán)周期,否則,系統(tǒng)進入保護模式,切斷伺服驅動器的SRV—ON信號。
?
?
2.4 位置環(huán)路控制策略
位置環(huán)設計是系統(tǒng)設計的關鍵環(huán)節(jié),由于系統(tǒng)需要,該環(huán)路不能有振蕩、超調現(xiàn)象,同時又要保證快速性。在位置環(huán)的設計中采用了滑模變結構的控制方法,滑模控制的優(yōu)點是能夠克服系統(tǒng)的不確定性,對干擾和未建模動態(tài)具有很強的魯棒性,尤其是對非線性系統(tǒng)的控制具有良好的效果。其最大的優(yōu)點是滑動模態(tài)對加在系統(tǒng)上的干擾和系統(tǒng)的攝動具有完全的自適應性,而且系統(tǒng)狀態(tài)一旦進滑模運動,便能夠快速收斂到目標控制,為時滯系統(tǒng),不確定性系統(tǒng)的魯棒性設計提供了一種有效的途徑。變結構控制可以解決系統(tǒng)大角速度調轉和穩(wěn)定過渡的難題;當位置誤差小于一定量時,系統(tǒng)切換到PI控制器,以此滿足系統(tǒng)的穩(wěn)定性和精度要求。系統(tǒng)原理結構如圖6所示,其中VSS表示滑模變結構控制器,P+I表示比例積分控制器。
?
?
控制策略為:
?
?
2.5 安全控制策略
雷達伺服系統(tǒng)是一個復雜的機電一體化系統(tǒng),在工作過程中處于高速轉動狀態(tài),在人員操作失誤或設備失控飛車的情況下,都有可能對人員或設備造成傷害,所以在系統(tǒng)設計時需要重點考慮安全控制策略,本系統(tǒng)的安全設計主要從以下幾個方面入手:伺服驅動器上電延時設計、開機自檢、DSP自身工作檢測、伺服驅動器檢測、俯仰機構抱閘設計、通信鏈路檢測、俯仰機構限位檢測等。
?
?
安全控制邏輯組合電路如圖7所示,其工作過程為:系統(tǒng)上電后,硬件延時電路對DELAY信號進行延時,延時時間到之后,DELAY輸出高電平,延時的目的是為了保證各外圍電路正常工作之后才能啟動SBV—ON信號。DSP自檢完成之后,如果DSP工作正常,則GPI020送出方波信號,通過54HCT123將其展寬后變?yōu)楦唠娖叫盘査腿胨?輸入與門電路CD4081,否則54HCT123送出低電平信號,其作用是實時判斷DSP是否工作正常,防止程序跑飛或DSP死機;TOP,BOTTOM為俯仰機構上、下限位信號,正常情況下為高電平,如果觸發(fā)電氣限位,則變?yōu)榈碗娖?ALM信號為DSP送出的報警信號,如果DSP檢測到各故障報警信號均正常,則DSP送出高電平,否則送出低電平。CD4081對各路輸入信號進行邏輯與運算,如果各檢測信號均為高電平,則說明系統(tǒng)工作正常,啟動SRV—ON,伺服驅動器工作,否則認為伺服系統(tǒng)出現(xiàn)故障,SBV—ON信號送出高電平,伺服驅動器停止工作。
3 電磁兼容設計
雷達系統(tǒng)是集微波、電子、電氣、精密機械為一體的復雜裝置。其工作時將會產生各種感應和干擾,在這種復雜的電磁環(huán)境下工作,有可能導致伺服系統(tǒng)出現(xiàn)故障甚至無法正常運行;而伺服系統(tǒng)工作時本身也是一個干擾源,伺服驅動器內的電力電子器件的電流通斷造成的開關噪聲,電感負載電流切斷引起的噪聲,接通負載時的沖擊電流和開關的抖動,動力傳輸線的發(fā)射,伺服控制器內高速數(shù)字電路運行產生的
干擾等,這些干擾都有可能影響雷達系統(tǒng)其他設備的正常工作,因此伺服系統(tǒng)的電磁兼容設計不容忽視。
本系統(tǒng)電磁兼容設計主要從以下幾個方面考慮:
1)信號線連接使用屏蔽線,伺服控制器和伺服驅動器采用金屬外殼封裝,對電磁干擾進行隔離屏蔽。
2)在電路板設計及電纜走線時考慮高低壓隔離,強弱電隔離,模擬電路和數(shù)字電路分開,交、直流電源分開。
3)合理接地,采用一點接地的方法,將電機外殼、動力線屏蔽層、驅動器外殼金屬接地。接地線必須短而粗,使得接地電阻和電感較小,免得引入額外的干擾。接地線與大地連接良好。
4)對電源和有關信號進行有效濾波,減小干擾。
4 試驗結果
經測試,系統(tǒng)定位精度達到0.012°(RMS),調速范圍0.05°/s~60°/s,測角精度為0.01°(RMS),最大加速度60°/s2,各項技術指標及環(huán)境適應性滿足設計要求。
5 結束語
文中詳述了以TMS320F28335芯片為核心構成的伺服系統(tǒng)的設計方案,采用該方案設計的雷達伺服系統(tǒng)已經在多次試驗中得到驗證,實踐證明,該系統(tǒng)可靠性高,穩(wěn)定性好,易于調試,滿足設計指標及環(huán)境適應性要求。具有較強的工程實用價值。
光耦相關文章:光耦原理
電氣符號相關文章:電氣符號大全
c語言相關文章:c語言教程
伺服電機相關文章:伺服電機工作原理
接地電阻測試儀相關文章:接地電阻測試儀原理
評論