李科
摘要:穩(wěn)定平臺廣泛應(yīng)用于現(xiàn)代武器裝備中,為保證設(shè)備的正常工作狀態(tài),需要穩(wěn)定平臺隔離載體的干擾,保證設(shè)備工作環(huán)境的穩(wěn)定。本文主要完成了測姿傳感器的選型并完成了控制電路的設(shè)計,包括主控芯片的選型、串行通信電路設(shè)計、電源電路的設(shè)計、及保護電路的設(shè)計等,最后介紹了控制電路、驅(qū)動器、電機的電路連接方式。本文基本完成了平臺測控系統(tǒng)硬件設(shè)計,這為后續(xù)的的軟件設(shè)計和試驗提供了基本的硬件基礎(chǔ),達到預(yù)期設(shè)計目標(biāo)。
關(guān)鍵詞:穩(wěn)定平臺 測姿系統(tǒng) ATmega2560 伺服控制
中圖分類號:TN761.2 文獻標(biāo)識碼:A 文章編號:1007-9416(2016)07-0001-03
Abstract:Stabilized platform is widely used in modern weapons and equipment, to ensure the normal working state, needs a stable platform isolation carrier interference, ensure the stability of the equipment working environment. This paper mainly completed the selection of the position sensor and completed the design of the control circuit, including the main control chip selection, serial communication circuit design, the design of the power supply circuit, and the protection circuit design, etc., finally introduces the control circuit, drive, electrical circuit connection. This paper basically complete platform for measurement and control system hardware design, the software for the subsequent design and experiment provides the basic hardware foundation, the desired design goal.
Key Words:Stabilized platform; Attitude measurement system; ATmega2560; Servo control;
現(xiàn)代武器系統(tǒng)廣泛使用平臺,特別是艦載火炮系統(tǒng),制導(dǎo)系統(tǒng),雷達跟蹤系統(tǒng)和慣導(dǎo)系統(tǒng)等。隨著科技水平的發(fā)展,世界各國對現(xiàn)代武器系統(tǒng)的機動性、快反能力以及穩(wěn)定跟蹤和精確打擊能力也提出了更高的要求,因此,對對提高穩(wěn)定平臺系統(tǒng)性能的研究更為迫切。為保證設(shè)備的正常工作狀態(tài),需要載體對穩(wěn)定平臺的干擾,保證設(shè)備工作環(huán)境的穩(wěn)定。穩(wěn)定平臺主要作用即是隔離運動載體(如車輛、艦船、導(dǎo)彈等)在行進過程中對所搭載設(shè)備的干擾,使設(shè)備能有一個可靠的的工作環(huán)境[1]。穩(wěn)定平臺技術(shù)實現(xiàn)較難,跨度大且涵蓋學(xué)科較多,綜合了信號分析和數(shù)據(jù)采集技術(shù)、機械設(shè)計、機構(gòu)動力學(xué)和運動學(xué)、現(xiàn)代控制理論及傳感器技術(shù)等多個學(xué)科,主要在某些軍事領(lǐng)域和民用領(lǐng)域有重要的應(yīng)用[2],但是其通用產(chǎn)品不多。
1 測控系統(tǒng)硬件結(jié)構(gòu)
測控系統(tǒng)硬件作為一個載體,主要實現(xiàn)控制程序的執(zhí)行和控制策略的實現(xiàn),它是實現(xiàn)整個平臺控制系統(tǒng)的基礎(chǔ)。如圖1所示,測控系統(tǒng)核心芯片采用Atmega2560芯片及其它相應(yīng)功能的電路模塊組成的控制電路。該主控芯片通過串行通信接口0接收上位機發(fā)送的保持姿態(tài)信息,即二級平臺所要保持的姿態(tài)信息;同時測姿傳感器測得當(dāng)前姿態(tài)信息,通過串行通信接口1發(fā)送給主控芯片;然后主控芯片將收到的原來的保持姿態(tài)信息和當(dāng)前姿態(tài)信息進行比較解算,得到電機的轉(zhuǎn)動速度和轉(zhuǎn)動方向命令,并將命令通過2、3串行通信接口分別發(fā)送給方位驅(qū)動電機和俯仰驅(qū)動電機,再由驅(qū)動器控制電機完成相應(yīng)的動作,使得二級平臺穩(wěn)定在某個所需要姿態(tài)上。
2 穩(wěn)定平臺的姿態(tài)測量系統(tǒng)
平臺測姿系統(tǒng)包括對方位角和俯仰角參數(shù)的采集,以及對應(yīng)姿態(tài)信息在ATmega2560主控芯片中的解算和信號處理。傳感器通過串行通信接口與主控通信,為平臺提供姿態(tài)角信號。核心控制芯片將測姿傳感器測得的姿態(tài)角信息進行解算和處理后,給定驅(qū)動電機一個控制指令從而控制電機的運動達到平臺穩(wěn)定的目的。
目前使用最多的測姿方式主要包括雙天線/多天線GPS測姿、慣導(dǎo)測姿、GPS/INS組合測姿等。慣性導(dǎo)航系統(tǒng)(INS)是用慣性元件來測量載體運動的加速度和角加速度,經(jīng)過積分運算接出導(dǎo)航參數(shù)以確定載體位置和姿態(tài)。它與GPS導(dǎo)航系統(tǒng)不同,INS主要特點是:自主式、全天候、不會因外界干擾影響系統(tǒng)工作且無信號丟失。一般由三個加速度計、三個陀螺儀、導(dǎo)航計算機、穩(wěn)定平臺、控制器、電源及必要的外圍附件組成。GPS主要通過各個衛(wèi)星的廣播數(shù)據(jù)解算出自己當(dāng)前的位置信息和用戶到衛(wèi)星的距離,利用后處理軟件差分處理后的位置坐標(biāo)來解算航向角以及位置和速率。GPS的優(yōu)點是可全天候使用,相對INS沒有時間累計差,不足之處是受到遮蔽物的影響會使GPS接收有效星的能力下降。單獨使用GPS或INS獲取載體姿態(tài)通常存在缺陷,結(jié)合GPS和INS 各自的優(yōu)點,將GPS和INS相互綜合,融合兩類姿態(tài)信息可以獲得更精確可靠的姿態(tài)數(shù)據(jù),該系統(tǒng)能得到長期準確的姿態(tài)、速度和位置信息,其角精度可以達到0.1°,速度精度達到0.1m/s,航向角精度≤0.3°,俯仰角精度≤0.2°。因此本文選GPS/慣導(dǎo)組合系統(tǒng)INS1200作為穩(wěn)定平臺的測姿傳感器,采用RS232通訊用于同步通訊。該系統(tǒng)涵蓋了GPS和INS的測姿優(yōu)勢,能得到準確的航向角度、俯仰角度、經(jīng)緯度、高度、角速度等需求的參數(shù)信息,同時為了進一步提高系統(tǒng)精度和適用性我們可以采用擴展相應(yīng)的外圍配套(如擴展里程計等),并且該系統(tǒng)的數(shù)據(jù)輸出率最高可達100Hz,這對于平臺的高度動態(tài)和實時調(diào)整是尤為重要的。該系統(tǒng)的主要優(yōu)點是:體積較小、性價比高、重量輕,目前主要用于車船和飛機等的導(dǎo)航以及穩(wěn)定平臺系統(tǒng)等領(lǐng)域。
3 控制電路設(shè)計
3.1 控制電路結(jié)構(gòu)
控制電路結(jié)構(gòu)框圖如圖2[3]。
3.2 主控芯片選定及串行通信接口電路
由于ATmega2560芯片[4]具有運算速率快且片上資源豐富,本設(shè)計采用該芯片作為控制電路微處理器;該芯片16路模擬輸入,4路UART接口,一個16MHz晶體振蕩器,一個USB口,一個電源 插座,一個ICSP header和一個復(fù)位按鈕且支持I2C接口。測姿傳感器、電機驅(qū)動器的通信采用標(biāo)準的RS232串行通信。一般來說,RS232串行通信接口具有升壓、電壓極性反轉(zhuǎn)能力,能夠產(chǎn)生+10V和-10V電壓,而微處理器的信號電壓是TTL電平,電源工作電壓是5V。為了與其他系統(tǒng)通信方式保持一致,本文選定使用較為通用的串行通信接口RS232,MAX232芯片串行通信接口電路如圖3。
3.3 電源及保護電路
我們需要提供穩(wěn)定的電源電壓才能使得主控芯片正常工作。本文采用LM2576芯片,且芯片提供三擋且可調(diào)的多個電壓檔。
如圖4所示,電源供電電路+12V輸入電壓經(jīng)芯片處理得到+5V,為主控芯片ATmega2560、串口芯片MAX232等供電。CZ1、CZ2 C1分別為磁珠和耐高壓電容,三者的功能主要為抑制輸入電壓中的噪聲信號,R1為壓敏電阻,對過高的輸入電壓進行電壓嵌位,防止電壓過大燒毀芯片。F1作為自恢復(fù)保險絲主要是保護電路及芯片,在電路供電電流過大或出現(xiàn)短路造成過電流時,自恢復(fù)保險絲迅速熔斷。D1與R1、F1組成供電電壓保護電路。
雙向瞬態(tài)抑制二極管能夠有效地保護電子線路中的精密元器件免受各種浪涌脈沖的損壞,具有響應(yīng)快,無噪聲等優(yōu)點,通常在通信保護電路中使用。
在模擬電路與數(shù)字電路之間的干擾容易導(dǎo)致芯片工作異常、通信出錯等,為了使設(shè)備符合電磁兼容性的要求,因此進行性電路隔離很有必要;電路隔離的主要目的即通過隔離數(shù)字與模擬電路以切斷噪聲干擾的路徑,達到抑制噪聲干擾的目的。如圖5所示,R4、C4、L1、C7組成低通濾波電路,防止數(shù)字電路的噪聲信號對模擬端造成干擾。CZ3為0歐姆電阻,其主要特點是電流路徑狹窄,可以限制噪聲電流通過,對所有頻率的噪聲都有一定的衰減作用,可保證數(shù)字地與模擬地等電位的,又可以清除數(shù)字電路對模擬電路的噪聲干擾[5]。
3.4 振蕩電路
如圖6所示,時鐘振蕩電路中的電容C9、C10的容值通常選擇為幾十pF。因為電容的大小對頻率有微調(diào)作用,影響振蕩的穩(wěn)定性和起振響應(yīng)速度。該振蕩電路中選擇電容值為15pF。另外,為了減小線路上的寄生電容,更好的保證電路穩(wěn)定、可靠工作,在PCB電路板設(shè)計中晶振和電容應(yīng)盡可能靠近主控芯片外接晶振引腳。
4 伺服控制模塊
伺服系統(tǒng)選用交流永磁同步伺服電機及與其匹配的驅(qū)動器,驅(qū)動器可以實時接收控制電路的指令,對電機轉(zhuǎn)速、方向、行程等實時控制,并且將以上的電機動作信息反饋給控制電路。
電機驅(qū)動器外部接口如圖7,供電電源接口接外部電源,為驅(qū)動器提供穩(wěn)定的工作電壓。電機接口連接超聲電機,為電機工作提供所需的脈沖電壓。RS232通訊接口與控制電路連接,負責(zé)接收主控芯片發(fā)送的控制電機的動作命令,并且通過驅(qū)動器的通信將電機的轉(zhuǎn)速等信息反饋給主控芯片。編碼器接口與電機編碼器連接,用于驅(qū)動器對電機轉(zhuǎn)速和行程實時監(jiān)測和控制[6]。
5 結(jié)語
本文主要首先完成了測姿傳感器的選型并完成了控制電路的設(shè)計,包括主控芯片的選型、串行通信電路設(shè)計、電源電路的設(shè)計、及保護電路的設(shè)計等,最后介紹了控制電路、驅(qū)動器、電機的電路連接方式。完成了平臺測控系統(tǒng)硬件設(shè)計,這為后續(xù)的的軟件設(shè)計和試驗提供了基本的硬件基礎(chǔ),達到預(yù)期設(shè)計目標(biāo)。
參考文獻
[1]周結(jié)華.基于運動載體的平臺穩(wěn)定系統(tǒng)控制方法研究[D].廈門:廈門大學(xué)碩士學(xué)位論文,2009.
[2] Hilkert JM. Inertially Stabilized Platform Technology Concepts and Principles[J].IEEE Control Systems Magazine, 2008,28(1):26-46.
[3]王德義,陳娟,孫德輝.基于Atmega128的電動云臺控制器設(shè)計[J].電力自動化設(shè)備,2010, (6):140-142.
[4]周潤景,郝媛媛.Altium Designer原理圖與PCB設(shè)計[M].北京:電子工業(yè)出版社,2012.
[5]Peter J.Kennedy, Rhonda L Kennedy. Direct Versus Indirect Line of Sight Stabilization[J]. IEEE Transactions on Control Systems Technology,2003,11(1): 3-15.
[6]李賢濤.航空光電穩(wěn)定平臺擾動抑制技術(shù)的研究[D].長春:中國科學(xué)院研究生院(長春光學(xué)精密機械與物理研究所)博士學(xué)位論文,2014.