某飛行器舵機(jī)控制系統(tǒng)硬件設(shè)計(jì)
摘要:研究一種基于TMS320F28335 DSP(Digital Signal Processor)的全數(shù)字飛行器控制系統(tǒng)的硬件設(shè)計(jì),分析了其結(jié)構(gòu)組成:主控制器電路、舵面位置檢測(cè)電路和通訊等硬件電路設(shè)計(jì)。經(jīng)過(guò)多次試驗(yàn)調(diào)試,所設(shè)計(jì)的硬件系統(tǒng)可以滿(mǎn)足飛行器性能要求。
關(guān)鍵詞:飛行器;TMS320F28335;控制系統(tǒng);硬件電路
隨著科學(xué)技術(shù)的發(fā)展進(jìn)步,對(duì)飛行器飛行控制系統(tǒng)要求的不斷提高,使得用傳統(tǒng)的設(shè)計(jì)模擬飛行控制器設(shè)計(jì)方法無(wú)法滿(mǎn)足要求。高速處理芯片的推出使研究導(dǎo)彈飛行器等非線性控制系統(tǒng)設(shè)計(jì)具有現(xiàn)實(shí)和長(zhǎng)遠(yuǎn)意義?;诖朔N原因,為提高飛行控制器的可靠性和控制精度,本文采用TI公司的32位浮點(diǎn)DSP(TMS320F28335)為控制器核心,完成數(shù)字信號(hào)處理和導(dǎo)航解算,以及串口通信,數(shù)據(jù)采集和人機(jī)交換等任務(wù)。
1 控制系統(tǒng)原理
舵機(jī)控制系統(tǒng)是按照選定的導(dǎo)引規(guī)律不斷調(diào)整與修正飛行器的飛行軌跡,導(dǎo)引和控制飛行器飛向目標(biāo)的硬件和軟件集合。它的功能包括設(shè)定目標(biāo)和飛行器的飛行參數(shù),按照選定的導(dǎo)引規(guī)律形成飛行器飛行控制指令,經(jīng)綜合、校正后輸出控制指令調(diào)整舵機(jī)推力方向或舵面偏轉(zhuǎn)角,改變飛行器的飛行狀態(tài)和飛行路線,使飛行器按允許誤差命中目標(biāo)。飛行器如果偏離控制系統(tǒng)預(yù)先設(shè)定的狀態(tài)(飛行姿態(tài)發(fā)生變化),通過(guò)傳感器可探測(cè)到偏離的方向和大小,控制器按照相應(yīng)的控制算法處理偏差后,輸出一定的控制信號(hào)操縱相應(yīng)的舵機(jī),控制對(duì)應(yīng)舵面進(jìn)行偏轉(zhuǎn),使飛行器姿態(tài)角逐漸達(dá)到設(shè)定狀態(tài)。從而達(dá)到改變飛行器的飛行狀態(tài)和飛行路線,使飛行器按規(guī)定的誤差擊中目標(biāo)。當(dāng)飛行器姿態(tài)角到達(dá)預(yù)先設(shè)定狀態(tài),則舵面回歸初始位置,飛行器此時(shí)按設(shè)定姿態(tài)正常飛行。飛行器控制系統(tǒng)原理如圖1所示。
2 舵機(jī)控制系統(tǒng)硬件結(jié)構(gòu)
飛行器舵機(jī)控制系統(tǒng)主要有捷聯(lián)慣導(dǎo)系統(tǒng)、主控制器及舵機(jī)部分構(gòu)成。飛行器的實(shí)時(shí)飛行姿態(tài)信息有捷聯(lián)慣導(dǎo)系統(tǒng)給定,DSP通過(guò)與預(yù)定姿態(tài)信息求偏差后得到4路舵機(jī)舵面的預(yù)定參考位置。舵面的實(shí)時(shí)位置信號(hào)是由舵機(jī)輸出軸上的角度傳感器提供,該位置信號(hào)經(jīng)過(guò)調(diào)理電路處理之后輸入到DSP的AD采樣端。主控制器以DSP為核心經(jīng)過(guò)內(nèi)部控制算法處理后輸出各種控制信號(hào),輸出的控制信號(hào)經(jīng)過(guò)專(zhuān)用4路舵機(jī)驅(qū)動(dòng)板卡,驅(qū)動(dòng)4路舵機(jī)按要求轉(zhuǎn)動(dòng)。舵機(jī)系統(tǒng)作為飛行控制的執(zhí)行機(jī)構(gòu),由4套無(wú)刷直流電機(jī)、諧波減速器、位置傳感器組成。分別安裝在飛行器尾部相互垂直的兩個(gè)軸平面上,其安裝位置順時(shí)針排序?yàn)?#、2#、3#、4#舵機(jī),在具體使用過(guò)程中,1#舵機(jī)和3#舵機(jī)可配合同步使用,2#舵機(jī)和4#舵機(jī)可配合同步使用。整個(gè)系統(tǒng)的硬件結(jié)構(gòu)如圖2所示。
本系統(tǒng)由上位機(jī)向飛行控制器發(fā)送飛行器預(yù)先設(shè)定的控制指令,通過(guò)UART總線傳輸?shù)街骺刂破鳌=萋?lián)慣導(dǎo)系統(tǒng)中飛行器實(shí)時(shí)姿態(tài)數(shù)據(jù)、線性電位器上舵面實(shí)時(shí)位置信號(hào)以及上位機(jī)上預(yù)設(shè)的控制指令數(shù)據(jù),共同組合后代入到的飛行控制算法中。通過(guò)主控制器處理后得到的PWM波形,輸出到舵機(jī)驅(qū)動(dòng)板卡實(shí)現(xiàn)對(duì)舵機(jī)舵面調(diào)整,進(jìn)而實(shí)現(xiàn)對(duì)飛行器的控制。此外,主控制器還將系統(tǒng)運(yùn)行狀態(tài)傳送至上位機(jī),通過(guò)PC機(jī)上的測(cè)控應(yīng)用程序?qū)崿F(xiàn)對(duì)控制系統(tǒng)監(jiān)測(cè)和后期數(shù)據(jù)處理。
3 系統(tǒng)硬件設(shè)計(jì)
3.1 主控芯片的選擇
德州儀器(TI)公司DSP產(chǎn)品中TMS320F28X系列數(shù)字信號(hào)處理器內(nèi)嵌32位DSP核,運(yùn)算速度可達(dá)150MIPS,還具有豐富的外設(shè),以及較強(qiáng)的運(yùn)算、控制和通信能力,其在電力、汽車(chē)、航天、通訊、工業(yè)、醫(yī)療等方面得到廣泛應(yīng)用。本系統(tǒng)采用的是TI公司推出的新型浮點(diǎn)型數(shù)字信號(hào)控制器(TMS320F28335),具有32位單精度浮點(diǎn)運(yùn)算單元(FPU),每秒可做300兆次浮點(diǎn)運(yùn)算,可實(shí)現(xiàn)許多復(fù)雜的控制算法。與以往的定點(diǎn)DSP相比,該器件的精度高,成本低,功耗小,性能高,外設(shè)集成度高,數(shù)據(jù)以及程序存儲(chǔ)量大,A/D轉(zhuǎn)換更精確快速,性能提高50%,快速傅立葉轉(zhuǎn)化(FFT)等復(fù)雜計(jì)算算法性能提升了一倍之多。擁有足夠的程序和數(shù)據(jù)空間,并且外設(shè)有豐富的接口,一個(gè)I2C總線,一個(gè)SPI口,16路12位A/D,3個(gè)SCI口等,使得系統(tǒng)外圍電路的設(shè)計(jì)簡(jiǎn)化了,從而簡(jiǎn)化軟件開(kāi)發(fā),縮短開(kāi)發(fā)周期,降低開(kāi)發(fā)成本,同時(shí)有效地提高了整個(gè)系統(tǒng)的集成度。
3.2 舵面位置檢測(cè)電路
系統(tǒng)控制精度是整個(gè)系統(tǒng)最重要的技術(shù)指標(biāo)之一,系統(tǒng)的檢測(cè)裝置和輸出控制元件一般決定了系統(tǒng)的控制精度。本系統(tǒng)的舵面位置檢測(cè)器件選擇精密導(dǎo)電電位計(jì)。舵面位置檢測(cè)傳感器其檢測(cè)的原理示意圖如圖3所示。線性電位器的滑動(dòng)端與減速器同軸相連,一旦舵面位置發(fā)生改變,線性電位器阻值產(chǎn)生線性變化,其電壓發(fā)生相應(yīng)線性變化。
TMS320F28335具有16路ADC轉(zhuǎn)換通道,采樣精度為12位。但ADC輸入通道的電壓范圍為0~3 V,因此需將舵面位置偏轉(zhuǎn)信號(hào)的范圍調(diào)節(jié)至0~3 V的范圍內(nèi)。本系統(tǒng)設(shè)計(jì)恒流源電路、二階低通濾波電路、差分電路、同向放大電路實(shí)現(xiàn)電壓范圍的調(diào)整。恒流源的設(shè)計(jì)保證了傳感器獲得的電流恒定,防止了因傳感器電流不穩(wěn)定而導(dǎo)致采集舵面位置數(shù)據(jù)的不準(zhǔn)確。將采集的數(shù)據(jù)通過(guò)二階低通濾波電路,濾除外界干擾,增加系統(tǒng)的抗干擾能力;差分電路作用是減去恒流源對(duì)傳感器拉升的電壓。
3.3 串行通信接口(SCI)設(shè)計(jì)
為了保證對(duì)導(dǎo)航儀數(shù)據(jù)采集的準(zhǔn)確性和實(shí)時(shí)性,所以使用RS422通信協(xié)議采集導(dǎo)航儀數(shù)據(jù)。RS422的數(shù)據(jù)傳輸采用差分平衡傳輸方式,抗噪聲能力前,傳輸距離遠(yuǎn),傳輸速度快和精度高等優(yōu)點(diǎn)。采用SP3491芯片作為RS422的的全雙工收發(fā)器,滿(mǎn)足RS422串行協(xié)議的要求,數(shù)據(jù)傳輸速率可達(dá)10 Mbps(帶負(fù)載)。F28335具有16位FIFO和波特率自檢測(cè)功能。選用16為FIFO接收數(shù)據(jù),每次可接收16位導(dǎo)航儀數(shù)據(jù),提高接收速度和準(zhǔn)確率。
人機(jī)通信使用RS232通信協(xié)議,RS232是目前PC機(jī)和通信工業(yè)應(yīng)用最廣泛的傳信通信接口,采取不平衡傳輸方式,是為點(diǎn)對(duì)點(diǎn)通信設(shè)計(jì)的,驅(qū)動(dòng)負(fù)載為3~7千歐姆,適合本地設(shè)備之間通信。RS232串口芯片選用MAX232串口驅(qū)動(dòng)芯片,是美信(MAXIM)公司為RS232通信串口設(shè)計(jì)的電平轉(zhuǎn)換芯片,使用+5 V單電源供電。
選擇接收中斷收發(fā)模式進(jìn)行通信,DSP在中端點(diǎn)掃描串口中斷標(biāo)志位,一旦發(fā)現(xiàn)接收標(biāo)志位置位就取緩存數(shù)據(jù),否則跳過(guò)執(zhí)行其他命令,不需占用大量CPU時(shí)間,以及接收數(shù)據(jù)的完整,不丟幀。當(dāng)有數(shù)據(jù)要發(fā)送給上位機(jī)時(shí),將數(shù)據(jù)寫(xiě)入發(fā)送緩存,發(fā)送標(biāo)志位置位DSP進(jìn)入中斷,數(shù)據(jù)發(fā)送。
3.4 舵機(jī)控制電路設(shè)計(jì)
TMS320F28335的EPWM模塊產(chǎn)生4路PWM信號(hào),4路方向信號(hào)。DSP輸出的是3.3 V邏輯TTL電平,因此在電路中加入74LV245芯片,一方面可防止電機(jī)驅(qū)動(dòng)板對(duì)DSP芯片的反向電流,起保護(hù)主控制器的作用;另一方面此芯片還可以起到增大驅(qū)動(dòng)能力的作用,使輸出信號(hào)具有更大電流。從DSP輸出到74LV245的信號(hào)都屬于數(shù)字信號(hào),與電機(jī)驅(qū)動(dòng)板電氣沒(méi)有直接聯(lián)系。如果直接將數(shù)字驅(qū)動(dòng)信號(hào)與電機(jī)驅(qū)動(dòng)板共地并作為電機(jī)驅(qū)動(dòng)板的輸入,則電機(jī)驅(qū)動(dòng)板對(duì)主控制器工作產(chǎn)生干擾,并降低系統(tǒng)抗干擾能力。因此采用光耦隔離的方法將主控制器與電機(jī)驅(qū)動(dòng)板隔離。
3.5 系統(tǒng)電源設(shè)計(jì)
飛行器所帶DC—DC電源模塊供電電壓為36 V和12 V。其中36 V為舵機(jī)系統(tǒng)供電:12 V是為主控制系統(tǒng)供電。而在主控制系統(tǒng)中還需要5 V、3.3 V、1.9 V電壓,其中5 V為系統(tǒng)內(nèi)部分模擬器件電源供電,3.3 V為本控制系統(tǒng)大部分?jǐn)?shù)字芯片供電以及作為DSP外設(shè)工作電源,1.9 V為DSP內(nèi)核供電。其中5 V是由12 V通過(guò)LM7805電源管理芯片轉(zhuǎn)換得到的,其輸出電流可達(dá)到1 A,可滿(mǎn)足主控制系統(tǒng)的需要。TMS320F2 8335(DSP)對(duì)內(nèi)部模塊的上電順序也有要求,首先必須對(duì)外設(shè)模塊上電,等電壓穩(wěn)定之后,才能對(duì)TMS320F28335的內(nèi)核進(jìn)行上電,否則系統(tǒng)將無(wú)法正常工作。選用TI公司的TPS73HD301非線性電源芯片,其優(yōu)點(diǎn)就是5 V電壓輸入,3.3 V產(chǎn)生200 ms延時(shí)后1.9 V產(chǎn)生.為T(mén)MS320F28335的上電順序提供了保障,輸出電流可達(dá)1A,輸出功率大,驅(qū)動(dòng)負(fù)載能力強(qiáng),而具有短路保護(hù)及熱保護(hù)等功能。
4 結(jié)束語(yǔ)
系統(tǒng)設(shè)計(jì)實(shí)現(xiàn)了以TMS320F28335處理器為控制核心,使用SCI串口為通訊方式,采用獨(dú)立的四路EPWM輸出方法,運(yùn)用12位AD采集舵面位置信號(hào)的控制系統(tǒng)。該系統(tǒng)充分利用了TMS320F28335高速運(yùn)算處理能力以及其豐富的外部接口特點(diǎn),簡(jiǎn)化了電路設(shè)計(jì)的難度,提高了可靠性。在硬件設(shè)計(jì)的整個(gè)過(guò)程中,系統(tǒng)控制器集成化,小型化,并且注重可靠性和抗干擾能力,實(shí)現(xiàn)了飛行器控制系統(tǒng)對(duì)硬件功能要求。
評(píng)論