王 嘉，黃巖平，張玉廣

(中國船舶重工集團(tuán)公司第七一八研究所，河北 邯鄲 056027)

0 引言

光電跟蹤系統(tǒng)是一個集圖像采集處理、伺服控制以及精密機械于一體的復(fù)雜設(shè)備。根據(jù)光電傳感器采集到的視軸與被跟蹤目標(biāo)之間的偏差信號，通過伺服系統(tǒng)控制視軸運動來減小跟蹤誤差，實現(xiàn)對目標(biāo)的自動跟蹤，其對實時性、準(zhǔn)確性有較高的要求。

光電跟蹤系統(tǒng)一直以來在軍事上應(yīng)用廣泛，比如武器控制方面等。近幾年，光電跟蹤系統(tǒng)發(fā)展十分迅速，被廣泛應(yīng)用于公安、消防以及環(huán)境監(jiān)控等民用領(lǐng)域，在機場安全、起降跟蹤、船舶助航、防海盜、邊海防安全、高空瞭望監(jiān)控等都有廣泛應(yīng)用，尤其隨著我國海洋開發(fā)的進(jìn)展，該系統(tǒng)特別適合于安裝在漁政船、巡邏船、救助船、緝私船等艦船上，對維護(hù)我國海洋權(quán)益發(fā)揮重要的作用。

伺服控制是光電跟蹤系統(tǒng)的重要組成部分，傳統(tǒng)的轉(zhuǎn)臺伺服控制采用的是對每個軸系進(jìn)行精確的模型分析，通過確定系統(tǒng)參數(shù)進(jìn)而確定控制參數(shù)，一般都采用多個回路以及復(fù)合控制等先進(jìn)技術(shù)方法實現(xiàn)。但由于光電跟蹤系統(tǒng)結(jié)構(gòu)復(fù)雜，許多參數(shù)難以精確確定，在建立系統(tǒng)的數(shù)學(xué)模型時，具有嚴(yán)重的非線性等原因使得這種做法設(shè)計復(fù)雜，開發(fā)難度大，周期時間長，對環(huán)境變化的適應(yīng)性比較差，可靠性不高。

本文立足于設(shè)計一種抗擾動的精密伺服轉(zhuǎn)臺，使用TMS320C6713 DSP作為核心處理器，配合PCL6045B專業(yè)的運動控制芯片來共同控制電機，DSP通過片外存儲器讀寫操作就達(dá)到了對電機的復(fù)雜控制。對于CPU來說是一種負(fù)擔(dān)的減輕，而且PCL6045B自身的閉環(huán)控制功能保證伺服轉(zhuǎn)臺的精確度，提高了可靠性，在滿足實際使用要求的前提下簡化了設(shè)計過程。

1 轉(zhuǎn)臺總體結(jié)構(gòu)設(shè)計

與陸地環(huán)境不同，海洋環(huán)境中，在風(fēng)的作用下會出現(xiàn)不同的海況。由于海浪對船體的影響，光電跟蹤系統(tǒng)會發(fā)生周期性的搖擺 (橫搖、縱搖、首搖、升沉等)，使視軸相對目標(biāo)產(chǎn)生大的角度晃動，造成圖像模糊，甚至丟失目標(biāo)，因此，為了隔離載體運動產(chǎn)生的擾動誤差，本系統(tǒng)采用抗擾動的設(shè)計，系統(tǒng)由轉(zhuǎn)臺底座、速率陀螺、方位和俯仰軸系上的電機、主軸、導(dǎo)電滑環(huán)等組成。光電跟蹤轉(zhuǎn)臺系統(tǒng)結(jié)構(gòu)如圖1所示。

圖1 轉(zhuǎn)臺結(jié)構(gòu)示意圖Fig.1 Turntable structure diagram

底座用來穩(wěn)定轉(zhuǎn)臺，增大系統(tǒng)的慣性，當(dāng)有外部振動干擾時減小對系統(tǒng)的影響。2個電機分別安裝在俯仰軸的軸向方向和底座內(nèi)部的中心垂直軸上，用來帶動俯仰軸和方位軸的轉(zhuǎn)動。攝像頭固定在俯仰軸上，通過電機帶動方位軸和俯仰軸轉(zhuǎn)動使得鏡頭可以對準(zhǔn)允許視場內(nèi)的任意方向。導(dǎo)電滑環(huán)安裝在方位軸和底座之間，用來在有軸向相對運動的兩側(cè)實現(xiàn)圖像、控制信號的傳遞，使得軸向旋轉(zhuǎn)不受信號線的影響。速率陀螺用來提供外部干擾的速度反饋信息，根據(jù)文獻(xiàn)［3］的理論，系統(tǒng)在3個軸系上安裝了單自由度速率陀螺，1個在底座的垂直軸上，另2個安裝在方位軸平面上相互垂直的2個方向上。根據(jù)測得的速度大小可以反推出轉(zhuǎn)臺穩(wěn)定所需要進(jìn)行的速度補償

圖2 三坐標(biāo)系空間關(guān)系示意圖Fig.2 Three coordinate system spatial relationship diagram

2 轉(zhuǎn)臺伺服控制硬件設(shè)計

光電跟蹤系統(tǒng)的主體由圖像采集處理單元和運動控制單元2個部分構(gòu)成。傳統(tǒng)的設(shè)計中運動控制單元需要用到伺服控制器，涉及到復(fù)雜的系統(tǒng)建模以及控制算法，使得運動控制的可靠性不高。本次設(shè)計采用運動控制芯片來解決這一問題，既可完成復(fù)雜的運動控制，又可提高系統(tǒng)的集成度，降低了成本。

在本設(shè)計中，TMS320C6713的應(yīng)用主要是作為圖像處理單元以及控制指令、參數(shù)發(fā)送單元。攝像機采集的圖像信號經(jīng)過AD轉(zhuǎn)換由FPGA對其進(jìn)行預(yù)處理，之后通過TMS320C6713進(jìn)行圖像分割、匹配、跟蹤處理，得到目標(biāo)與視軸中心的偏差量，然后TMS320C6713通過對運動控制芯片PCL6045B寄存器的訪問來發(fā)送控制參數(shù)以及指令，PCL6045B再根據(jù)指令以及反饋的電機運動信息調(diào)整驅(qū)動器輸出，對方位軸和俯仰軸電機進(jìn)行控制，完成對目標(biāo)的自動跟蹤。圖3所示為系統(tǒng)結(jié)構(gòu)框圖。

圖3 系統(tǒng)硬件結(jié)構(gòu)框圖Fig.3 System hardware structure diagram

2.1 TMS320C6713的EMIF接口配置

本次設(shè)計中的圖像處理單元必須擁有強大的運算處理能力，同時需要有一定的外部擴展接口，便于和后續(xù)的控制電路通信。TMS320C6713是一款功能強大的DSP，滿足設(shè)計中對圖像處理單元的要求，首先是可以同時處理8條32 bit的指令，其次是具有豐富的外部擴展功能，TMS320C6713的EMIF(外存儲器接口)是外部存儲器和TMS320C6713片內(nèi)各單元間的接口，CPU訪問片外存儲器時必須通過EMIF，C6000系列的EMIF具有很強的接口能力，其數(shù)據(jù)總線寬度為32 bit，同時也提供對8/16 bit寄存器的讀寫支持，EMIF的可尋址空間一共有512 Mb，分為4個彼此獨立的空間CE0～CE3，可以進(jìn)行不同的訪問控制，既提供了同步存儲器的高吞吐率接口，也支持異步存儲接口，而且異步接口速度、時序可編程。

本設(shè)計采用DSP和運動控制芯片的組合完成了轉(zhuǎn)臺伺服控制功能，作為一款功能強大的運動控制芯片，PCL6045B可以同時控制最多4個軸系的電機動作，具有比較優(yōu)秀的控制性能，TMS320C6713與PCL6045B的接口示意圖如4所示。

圖4中，CE0為外部映射空間使能輸出;EA［2∶5］為外部地址輸出;ED［0∶15］為外部數(shù)據(jù)總線;AWE為異步存儲器寫使能輸出;ARE為異步存儲器讀使能輸出;EXT-INT4為外部中斷輸入;ARDY為異步存儲器準(zhǔn)備輸入;RESET為復(fù)位輸入。

圖4 接口示意圖Fig.4 Interface diagram

除了硬件接口可以直接連接，在時序控制上還可以根據(jù)器件的情況靈活設(shè)置，EMIF的配置是通過對EMIF的控制寄存器設(shè)置完成的，主要是對CECTL0(CE0空間控制寄存器)的設(shè)置，CE空間控制寄存器對于讀/寫操作的建立、觸發(fā)和保持3個階段的時間可以進(jìn)行獨立的設(shè)置，工作時首先是片選信號CE0和地址信號EA變?yōu)橛行В缓笫亲x/寫信號ARE/AWE有效，之后結(jié)束1個訪問周期，完成讀/寫操作，設(shè)計中需要保證接口電路信號發(fā)送、接收的時序有效性，這在后續(xù)的軟件設(shè)計中體現(xiàn)。

2.2 PCL6045B的接口配置

本次設(shè)計中采用PCL6045B作為運動控制單元核心，作為一種通過總線接收CPU命令并產(chǎn)生高速脈沖控制電機的CMOS大規(guī)模集成芯片，芯片輸出脈沖頻率最高為6.5 MHz，可以提供各種脈沖控制功能，包括連續(xù)進(jìn)給、定位、勻速回零、線性加速/減速、S曲線加減速以及動作中速度以及目標(biāo)位置變更等;閉環(huán)以及補償控制是PCL6045B的重要功能，PCL6045B最多支持同時控制4個運動軸，支持中斷，并且可以向CPU提供PCL的工作狀態(tài)，還具有與伺服驅(qū)動器相連的驅(qū)動器接口，以上功能都可以通過比較簡單的指令實現(xiàn)，減少CPU控制電機產(chǎn)生的負(fù)擔(dān)。DSP通過總線訪問來對PCL進(jìn)行控制，PCL芯片有4個地址線A［1∶4］，A3和A4控制軸地址;A1和A2控制軸命令、寄存器以及I/O口地址，如表1和表2所示。

表1 軸地址Tab.1 Shaft address

表2 每軸命令、buffer及IO口地址Tab.2 Command，buffer and IO address for every axis

指令控制過程如下:

1)向BUFW0和BUFW1中寫入運動參數(shù)的高、低一共32 bit。

2)向COMW中寫入寄存器控制指令，當(dāng)寄存器控制指令寫入后，BUFW0和BUFW1中的運動控制參數(shù)會自動的寫入相應(yīng)的寄存器中。

3)向COMW中寫入啟動命令等控制指令，之后系統(tǒng)會根據(jù)寄存器中設(shè)定的參數(shù)來控制電機運轉(zhuǎn)。

對系統(tǒng)狀態(tài)的讀取與指令的寫入類似，只不過先是設(shè)置寄存器控制指令，之后才讀取緩沖器中的數(shù)據(jù)。

3 轉(zhuǎn)臺伺服控制軟件設(shè)計

系統(tǒng)工作時，首先設(shè)置運動參數(shù)，進(jìn)入數(shù)字引導(dǎo)模式，在確定了跟蹤目標(biāo)之后進(jìn)入自動跟蹤模式，系統(tǒng)根據(jù)目標(biāo)運動情況調(diào)整運動控制參數(shù)自動跟蹤，在出現(xiàn)目標(biāo)丟失跟蹤失敗或取消目標(biāo)的情況下再次進(jìn)入數(shù)字引導(dǎo)模式，系統(tǒng)軟件流程圖如圖5所示。

本設(shè)計中每30 ms更新一次數(shù)據(jù) (主要是考慮到圖像采集的頻率)，包括新的位置信息以及速度信息，以單軸為例，控制器需要設(shè)置的速度符合式(3)，新位置s滿足式(4)，如下所示:

其中:Δs為下一時刻目標(biāo)預(yù)測位置與當(dāng)前位置差;vit為速率陀螺反饋速度。

系統(tǒng)的軟件設(shè)計采用C語言、匯編語言編寫，使用TI公司的CCS編程環(huán)境，分以下2個步驟:

1)設(shè)置TMS320C6713EMIF相關(guān)的寄存器，保證邏輯地址對應(yīng)關(guān)系正確以及接口滿足各種時序要求;

2)對PCL6045B的訪問設(shè)置。首先是把運動控制參數(shù)傳遞給輸入輸出緩沖器BUFW0、BUFW1，之后發(fā)送控制器編碼到COMW，由于PCL6045B具有42個控制寄存器，而且支持預(yù)置寄存器功能，可以產(chǎn)生豐富的控制效果，達(dá)到各種控制要求，最后是發(fā)送控制指令編碼到COMW，PCL6045B支持單軸動作以及多軸同時動作，適用于各種情形。

圖5 軟件流程圖Fig.5 Software flow diagram

4 結(jié)語

與傳統(tǒng)的伺服控制設(shè)計方法不同，本設(shè)計采用TMS320C6713 DSP和PCL6045B運動控制芯片的組合完成轉(zhuǎn)臺伺服控制功能，并且考慮到海洋環(huán)境的特殊性，加入由速率陀螺反饋構(gòu)成的抗擾動設(shè)計，根據(jù)高性能的浮點DSP對圖像實時處理之后發(fā)送的目標(biāo)偏差量等信息來控制運動控制芯片產(chǎn)生復(fù)雜的控制脈沖，驅(qū)動電機完成跟蹤功能，提高了系統(tǒng)的集成度以及可靠性，對轉(zhuǎn)臺伺服控制的設(shè)計有一定的借鑒意義。

［1］Ti公司.TMS320C6713 Digital Signal Processor Data Manual.TI公司，2004.

［2］NPM 公司.PCL6045B Data Sheet.AD 公司，2005.

［3］趙建川，薛樂唐.速率陀螺在船載地平式電視跟蹤儀視軸穩(wěn)定中的應(yīng)用［J］.光電技術(shù)應(yīng)用，2009，24(1):22－25.

［4］李方慧，王飛，何佩琨，等.TMS320C6000系列 DSPs原理與應(yīng)用(第2版)［M］.北京:電子工業(yè)出版社，2003.

［5］三恒星科技.TMS320C6713 DSP原理與應(yīng)用實例［M］.北京:電子工業(yè)出版社，2009.

［6］葉佩青，張輝.PCL6045B運動控制與數(shù)控應(yīng)用［M］.北京:清華大學(xué)出版社，2007.