文獻(xiàn)標(biāo)識(shí)碼: A
文章編號(hào): 0258-7998(2010)07-0048-04
光電經(jīng)緯儀作為一種高精度的空間位置測(cè)量設(shè)備,,被廣泛應(yīng)用于海,、陸、空武器測(cè)試靶場(chǎng)及天文觀(guān)測(cè)和武器引導(dǎo)控制系統(tǒng),。它利用激光,、紅外、電視,、雷達(dá)等探測(cè)器獲得運(yùn)動(dòng)目標(biāo)在其視場(chǎng)內(nèi)與視場(chǎng)中心的偏差,,再將它傳輸給伺服跟蹤系統(tǒng)進(jìn)行校正跟蹤,使經(jīng)緯儀瞄準(zhǔn)該目標(biāo)并引導(dǎo)其他跟蹤設(shè)備,,或者根據(jù)激光測(cè)距和經(jīng)緯儀本身的位置數(shù)據(jù)計(jì)算出運(yùn)動(dòng)目標(biāo)的精確軌跡[1-2],。目前,隨著飛機(jī),、武器系統(tǒng)及測(cè)量系統(tǒng)的發(fā)展,,安裝可靠、靈活,、輕型的光電跟蹤設(shè)備已非常必要,。采用嵌入式系統(tǒng),尤其是基于DSP和FPGA的嵌入式模塊,,可以充分利用其自身優(yōu)點(diǎn)進(jìn)行小型化,、低功耗和高可靠性的系統(tǒng)設(shè)計(jì),。本文通過(guò)對(duì)光電經(jīng)緯儀的伺服跟蹤系統(tǒng)研究,,設(shè)計(jì)了一種基于DSP和FPGA的光電經(jīng)緯儀伺服跟蹤系統(tǒng)。
1 硬件平臺(tái)構(gòu)造
目前經(jīng)緯儀伺服跟蹤系統(tǒng)主要基于PC/104結(jié)構(gòu),,具體結(jié)構(gòu)如圖1所示,。它是通過(guò)引導(dǎo)主控計(jì)算機(jī)對(duì)運(yùn)動(dòng)目標(biāo)完成捕獲跟蹤功能。在實(shí)際的伺服系統(tǒng)應(yīng)用中,,要在PC104上疊加多塊控制電路板才能較好地運(yùn)行,。這樣就會(huì)增加體積并降低系統(tǒng)的可靠性,,且提高精度也很困難。
圖1所示的PC104伺服系統(tǒng)由多個(gè)功能模塊構(gòu)成,,主要包括主機(jī)模塊,、顯示控制模塊、數(shù)據(jù)采集和控制模塊,。選用不同種類(lèi)和數(shù)量的功能模塊通過(guò)堆疊式的PC104總線(xiàn)構(gòu)成小型化的嵌入式系統(tǒng),,其可靠性隨著功能模塊的增多而降低,而且成本較高,。
針對(duì)PC104光電經(jīng)緯儀控制系統(tǒng)的不足,,設(shè)計(jì)了一種以TI公司的TMS320F2812和ALTERA公司的FPGA芯片EP1C3T144作為主控制器的伺服系統(tǒng)。TMS320-
F2812屬于32 bit的定點(diǎn)DSP,,其作為主要的電機(jī)控制芯片有豐富的外設(shè)及快速的運(yùn)算能力,,與用于控制方面的其他單片機(jī)或DSP相比,擁有明顯的優(yōu)勢(shì),。能夠滿(mǎn)足高速跟蹤控制系統(tǒng)的要求,,并能運(yùn)行較復(fù)雜的控制算法,取得較好的控制效果。
為了充分發(fā)揮TMS320F2812強(qiáng)大的控制功能,,增加了FPGA芯片來(lái)協(xié)調(diào)DSP處理數(shù)據(jù)信號(hào),,使得多軸電機(jī)的控制及多接口實(shí)時(shí)通信變得很方便。ALTERA公司的EP1C3T144芯片應(yīng)用廣泛,,可靠性較高,,與TMS320F2812芯片相協(xié)調(diào),能夠獲得較高的性?xún)r(jià)比,。
基于DSP和FPGA的伺服控制系統(tǒng)主要由電源電路,、DSP、FPGA核心處理器,、串行通信接口,、A/D轉(zhuǎn)換電路、功率轉(zhuǎn)換電路及一些輔助電路組成,。電路結(jié)構(gòu)如圖2所示,。
1.1 通信接口
DSP作為主控制芯片,通過(guò)各種通信接口與外設(shè)或FPGA聯(lián)系,。DSP外部數(shù)據(jù)通過(guò)數(shù)據(jù)總線(xiàn)可以進(jìn)入DSP內(nèi)進(jìn)行處理,,也可以先送到FPGA內(nèi)部進(jìn)行預(yù)處理,處理完后通過(guò)總線(xiàn)傳給其他控制系統(tǒng)或DSP主控芯片進(jìn)行后續(xù)處理,。在系統(tǒng)的FPGA與DSP的數(shù)據(jù)交換主要采用DSP和FPGA之間的專(zhuān)用通信接口來(lái)處理,。兩者間通信可采用標(biāo)準(zhǔn)串行通信接口SPI。SPI接口是一種真正意義上的同步串行通信接口,,它在2個(gè)傳輸單元之間進(jìn)行數(shù)據(jù)傳輸時(shí)采用的是同一個(gè)時(shí)鐘,,可以達(dá)到很高的數(shù)據(jù)傳輸速率,。
數(shù)據(jù)總線(xiàn)采用16 bit的寬度,DSP和FPGA都能利用該總線(xiàn)與外部設(shè)備或是上位機(jī)進(jìn)行大量的數(shù)據(jù)交換,。TMS320F2812有2路SCI接口,,可以傳輸各種控制指令和控制狀態(tài)信息??梢岳肧CI接口采用RS422差分信號(hào)進(jìn)行控制指令的接收及控制狀態(tài)信息的反饋,。
1.2 力矩電機(jī)控制電路
力矩電機(jī)作為主要的控制對(duì)象在該系統(tǒng)中直接采用TMS320F2812的PWM接口進(jìn)行控制。TMS320F2812共有16路PWM輸出接口供電機(jī)使用,,通過(guò)控制PWM波的占空比來(lái)改變加在電機(jī)兩端的電壓,,從而改變電機(jī)的轉(zhuǎn)速。DSP發(fā)出的PWM波不能直接驅(qū)動(dòng)電機(jī)運(yùn)行,,須經(jīng)過(guò)IGBT進(jìn)行功率轉(zhuǎn)換,。該系統(tǒng)采用了IR公司的IR2210作為功率芯片。它把驅(qū)動(dòng)芯片和IGBT集成在一起,,只要輸入TTL信號(hào)就可以實(shí)現(xiàn)功率驅(qū)動(dòng),,而且具有完整的隔離及過(guò)流過(guò)壓保護(hù)功能。
1.3 信息顯示電路
信息顯示模塊主要完成外來(lái)信號(hào)狀態(tài)顯示,,如電機(jī)轉(zhuǎn)速,、角度等信息以及控制系統(tǒng)的故障信息顯示。這對(duì)于系統(tǒng)的調(diào)試及自檢都比較方便,。采用OLED(有機(jī)發(fā)光二極管顯示器)顯示信息,。顯示模塊VGS12864E由行驅(qū)動(dòng)器、列驅(qū)動(dòng)器和OLED顯示屏組成,。其主要控制電路通過(guò)FPGA的強(qiáng)大的邏輯控制功能實(shí)現(xiàn),,數(shù)據(jù)由DSP主控芯片或其他外設(shè)通信接口傳送給FPGA后,再由FPGA根據(jù)要求送到OLED中顯示,。
1.4 功能擴(kuò)展模塊
由于FPGA擁有較多的I/O資源,,因此便于擴(kuò)展功能。如圖2所示,,F(xiàn)PGA可以協(xié)助DSP完成數(shù)據(jù)采集功能,。這樣由DSP和FPGA組成的系統(tǒng)可以同時(shí)采集多路信號(hào),其中DSP芯片集成的12 bit A/D轉(zhuǎn)換電路主要采集精度不太高的信號(hào),,采樣后直接送入DSP內(nèi)部進(jìn)行處理,。對(duì)于高精度的信號(hào)采樣則通過(guò)FPGA外擴(kuò)采樣電路完成,并在FPGA內(nèi)部進(jìn)行信號(hào)的前期處理,,處理后的信號(hào)可以通過(guò)與DSP的通信接口傳送給DSP使用,,也可以直接送到信息顯示模塊上顯示,,以方便調(diào)試,。FPGA增加了故障提示電路,,能把系統(tǒng)內(nèi)發(fā)生的故障轉(zhuǎn)換成相關(guān)量送給外部設(shè)備判斷處理。同時(shí)FPGA增加了外部中斷接口,,可以讓多個(gè)外設(shè)信號(hào)接入FPGA,,然后才分時(shí)送給DSP進(jìn)行處理,這樣能充分利用系統(tǒng)資源,,實(shí)現(xiàn)多路信號(hào)實(shí)時(shí)處理,。
2 軟件結(jié)構(gòu)設(shè)計(jì)
2.1 FPGA的硬件編程設(shè)計(jì)
FPGA作為一種硬件可編程芯片,主要采用原理圖加硬件編程語(yǔ)言Verilog或是VHDL來(lái)完成,。最頂層采用原理圖連接方式將底層功能模塊連接起來(lái),,底層采用硬件編程語(yǔ)言構(gòu)建功能模塊電路。由于VHDL相對(duì)于Verilog編程語(yǔ)言更嚴(yán)密,,格式更規(guī)范,,所以在本文設(shè)計(jì)的系統(tǒng)中,采用VHDL進(jìn)行FPGA的編程,。底層模塊按功能主要分為以下幾個(gè)模塊:地址譯碼模塊,、中斷管理模塊、I/O管理模塊,、信息顯示模塊,、A/D采樣模塊、通信模塊,。FPGA內(nèi)部組成如圖3所示,。
地址譯碼的主要功能是將DSP輸入的外部地址信號(hào)進(jìn)行譯碼后送給FPGA的I/O管理模塊,管理FPGA的編碼器信號(hào)接收和A/D信號(hào)采集,。在該系統(tǒng)中把DSP的XINFF Zone 0區(qū)分配給FPGA使用,。DSP分配給FPGA的地址空間,通過(guò)譯碼電路處理模塊進(jìn)行再分配和再擴(kuò)充后分配給FPGA的其他外設(shè)使用,。這樣DSP可以間接控制FPGA的信息顯示模塊,、外部中斷等資源。
I/O管理模塊主要負(fù)責(zé)各種數(shù)字量輸入輸出以及特定信號(hào)的狀態(tài)設(shè)置,。I/O模塊連接FPGA的主要外設(shè),,以接收外設(shè)的信息并給外設(shè)輸出一定的控制命令。中斷管理模塊功能是擴(kuò)展DSP的外設(shè)中斷源,,接收各種外設(shè)中斷并進(jìn)行中斷排序,,對(duì)多個(gè)中斷輸入進(jìn)行優(yōu)先級(jí)控制和編碼。這樣可以使系統(tǒng)擁有多路信號(hào)的實(shí)時(shí)信號(hào)處理能力,,并分擔(dān)DSP的調(diào)度管理任務(wù),,使DSP能利用更多的資源去進(jìn)行復(fù)雜的位置、插值、數(shù)據(jù)濾波等算法處理,。
2.2 DSP伺服控制算法實(shí)現(xiàn)
為了提高控制系統(tǒng)的跟蹤精度,,在硬件平臺(tái)基礎(chǔ)上構(gòu)建了雙閉環(huán)反饋回路[3]。雙閉環(huán)反饋回路主要包括速度反饋和位置反饋回路,。位置反饋信息主要通過(guò)光電編碼器完成,。光電編碼器獲取位置后通過(guò)RS422接口直接送給FPGA進(jìn)行預(yù)處理,然后再通過(guò)與DSP通信通道送入DSP內(nèi)部運(yùn)算,。速度信息由采樣電路進(jìn)行離散化后送入DSP內(nèi)部運(yùn)算,。控制系統(tǒng)原理如圖4所示,。
伺服控制原理是把脫靶量或數(shù)引位置與系統(tǒng)的實(shí)際位置進(jìn)行相減得到誤差量,,把誤差量送給位置校正環(huán)節(jié)進(jìn)行放大,然后把位置信號(hào)輸出與經(jīng)過(guò)調(diào)節(jié)器后的速度前饋補(bǔ)信號(hào)相加作為速度校正環(huán)節(jié)的輸入信號(hào),,再通過(guò)速度校正環(huán)節(jié)處理,。系統(tǒng)根據(jù)速度回路的輸出信號(hào)對(duì)PWM進(jìn)行脈寬調(diào)制。最后把DSP輸出的PWM送入功率轉(zhuǎn)換電路進(jìn)行處理后送入電機(jī)執(zhí)行,。這樣電機(jī)向誤差量變小的方向運(yùn)動(dòng),,直至達(dá)到控制精度為止。
TMS320F2812屬于定點(diǎn)運(yùn)算芯片,,在編程進(jìn)行伺服控制時(shí)需要浮點(diǎn)運(yùn)算的算法,,此時(shí),要進(jìn)行一定的處理[4-5],。TI公司提供了用于定點(diǎn)DSP仿真實(shí)現(xiàn)浮點(diǎn)運(yùn)算的算法庫(kù)文件IQmath.h[6],,調(diào)用該文件可以很好地將伺服運(yùn)算程序移到F2812中運(yùn)行,并保證了一定的精度,。對(duì)多個(gè)電機(jī)的控制盡量采用中斷方式工作,,以降低DSP的開(kāi)銷(xiāo),提高實(shí)時(shí)性,。算法中的常用中間變量盡量分配到0等待的SRAM存儲(chǔ)空間上運(yùn)行,,這樣可以提高程序讀寫(xiě)數(shù)據(jù)的速度,提高算法的運(yùn)行效率,。程序流程圖如圖5所示,。
伺服控制算法通過(guò)速度反饋和位置反饋來(lái)實(shí)現(xiàn),速度反饋算法和位置反饋算法通過(guò)中斷方式完成[7],。這樣可以提高DSP實(shí)時(shí)處理能力,。
2.3 仿真實(shí)驗(yàn)結(jié)果與分析
基于DSP和FPGA的伺服跟蹤控制的正弦仿真結(jié)果如圖6所示。
從圖6可以看出,,控制系統(tǒng)的控制性能較好,,其穩(wěn)態(tài)誤差較小,。仿真結(jié)果表明,基于DSP和FPGA的跟蹤控制系統(tǒng)有效,、可行,。
光電經(jīng)緯儀為了提高跟蹤精度,對(duì)伺服控制系統(tǒng)有較高要求,,并采用復(fù)雜的控制算法來(lái)實(shí)現(xiàn)精度要求,,基于DSP和FPGA組成的伺服控制系統(tǒng)是一個(gè)效率很高的系統(tǒng),,有較大的發(fā)展?jié)摿?。隨著光電經(jīng)緯儀的發(fā)展,傳統(tǒng)的基于PC104的控制系統(tǒng)已很難滿(mǎn)足要求,,升級(jí)成本也很高,,DSP和FPGA構(gòu)成的控制系統(tǒng)可以替代PC104系統(tǒng)。本文設(shè)計(jì)的經(jīng)緯儀跟蹤系統(tǒng)通過(guò)實(shí)驗(yàn)測(cè)試表明具有較好的效果,,但對(duì)DSP和FPGA的協(xié)調(diào)處理還有些不足,,系統(tǒng)的升級(jí)優(yōu)化還有較大的空間。
參考文獻(xiàn)
[1] 何照才.光電測(cè)量[M].北京:國(guó)防工業(yè)出版社,,2002.
[2] 王建立.光電經(jīng)緯儀電視跟蹤,、捕獲快速運(yùn)動(dòng)目標(biāo)技術(shù)的研究[D].中科院長(zhǎng)春光學(xué)精密機(jī)械與物理研究
所,2002.
[3] 盧京潮.自動(dòng)控制原理[M].西安:西北工業(yè)大學(xué)出版社,,2004.
[4] 孫麗明.TMS320F2812原理及其C語(yǔ)言程序開(kāi)發(fā)[M]. 北京:清華大學(xué)出版社,,2008.
[5] 李佳武,張景森.定點(diǎn)DSP芯片TMS320F2812實(shí)現(xiàn)快速算法應(yīng)用[J].國(guó)外電子元器件,,2005(3):27-30.
[6] IQmath Library Module user′s Guide C28x Foundation Software(Rev.D).Texas Instruments,,2001.
[7] 李興紅,張淑梅,,續(xù)志軍,,等.基于TMS320F2812的跟蹤伺服系統(tǒng)[J].微計(jì)算機(jī)信息,2007(23):147-149.