基于DSP的光電搜跟設(shè)備伺服機構(gòu)控制器研究

作者/ 孫健 李釗 劉鵬飛 上海航天控制技術(shù)研究所(上海 201109)

摘要：針對光電搜跟設(shè)備對伺服控制機構(gòu)動、靜態(tài)響應(yīng)和跟蹤精度的要求，本文設(shè)計了基于DSP的光電跟蹤設(shè)備伺服機構(gòu)控制器。控制器以TMS320C28346為數(shù)據(jù)處理平臺，配置高性能外設(shè)結(jié)構(gòu)模塊和調(diào)理電路，通過合理優(yōu)化軟件流程，并對控制系統(tǒng)實施雙回路閉環(huán)控制，使得系統(tǒng)具有良好的跟蹤性能，系統(tǒng)結(jié)構(gòu)簡單，性能可靠，可為外場動態(tài)目標(biāo)的觀測和測試提供便捷和保障。

引言

　　光電搜跟設(shè)備是集光、機、電、控制與信號處理于一體的集成設(shè)備，通過光學(xué)儀器進行目標(biāo)探測，經(jīng)圖像處理得到獲取目標(biāo)脫靶量，控制伺服運動機構(gòu)實時運動，實現(xiàn)對目標(biāo)的有效捕獲與跟蹤^[1]。

　　高效的伺服控制是穩(wěn)定跟蹤的基礎(chǔ)，在伺服控制中設(shè)計滿足要求的控制器是關(guān)鍵。本文采用性能優(yōu)越的DSP作為光學(xué)搜跟設(shè)備伺服運動機構(gòu)的核心控制器，成本低廉，體積小巧，性能可靠。設(shè)計時采用合理的軟件流程，并通過數(shù)字PID控制使得系統(tǒng)更加穩(wěn)定，并具有良好的靜態(tài)和動態(tài)性能。系統(tǒng)可安裝于測試車上，便于對外場目標(biāo)進行動態(tài)觀測。

1 控制器組成及工作原理

　　光電搜跟設(shè)備主要由光學(xué)探測及圖像處理系統(tǒng)、伺服運動機構(gòu)及管理顯示系統(tǒng)組成，基于DSP的轉(zhuǎn)臺控制器作為伺服運動機構(gòu)的核心控制單元，圖1是光電搜跟設(shè)備系統(tǒng)框圖。主要包括控制芯片、電源模塊、串口通訊模塊、電機驅(qū)動模塊、編碼器采集模塊和外部時鐘模塊。如圖1所示，DSP控制器通過串口模塊實時讀取跟蹤器處理得到的目標(biāo)脫靶量信息，經(jīng)控制芯片數(shù)據(jù)處理，通過電機驅(qū)動模塊控制驅(qū)動器來驅(qū)動力矩電機運動，編碼器采集模塊通過實時采集編碼器數(shù)據(jù)來反饋伺服機構(gòu)位置信息，與控制信號構(gòu)成閉環(huán)回路，實現(xiàn)對伺服機構(gòu)的閉環(huán)控制。外部時鐘模塊可為控制芯片提供精確的時鐘，實現(xiàn)控制器對伺服機構(gòu)的實時控制。同時，控制器通過串口模塊將伺服機構(gòu)工作狀態(tài)和運動參數(shù)實時反饋管理計算機，實現(xiàn)伺服機構(gòu)工作過程中的實時監(jiān)控、參數(shù)設(shè)置及數(shù)據(jù)存儲。

　　本系統(tǒng)中DSP控制器有兩種工作模式，即搜索模式和跟蹤模式。搜索模式下，伺服機構(gòu)根據(jù)管理計算機的指令實現(xiàn)對空周掃或扇掃功能，此時，紅外熱像儀與電視跟蹤儀通過導(dǎo)電環(huán)中的光纖滑環(huán)將圖像信息傳輸?shù)綀D像處理器，圖像處理器再將圖像信息通過網(wǎng)絡(luò)發(fā)送給管理計算機。跟蹤模式下，跟蹤器實時解算光學(xué)探測器采集的圖像信息，并將計算得到的目標(biāo)與轉(zhuǎn)臺中心位置的脫靶量信息，實時發(fā)送至DSP控制器，控制器通過對伺服機構(gòu)的實時閉環(huán)控制，實現(xiàn)對目標(biāo)的跟蹤，為了提高跟蹤精度，控制器控制周期為1ms。

　　本系統(tǒng)中伺服機構(gòu)技術(shù)指標(biāo)如下：速度指標(biāo)中，方位：10°/s~360°/s，俯仰：10°/s~70°/s;位置精度中，方位：≤3mrad，俯仰：≤5mrad;轉(zhuǎn)臺頻率響應(yīng)特性指標(biāo)中，峰峰值為1°時， 在1Hz～10Hz時，輸出幅值特性≤1dB，輸出相位特性≤10o。

2 硬件設(shè)計

2.1 控制芯片

　　控制芯片采用TMS320F28346，該芯片基于TMS320C2xx內(nèi)核的浮點數(shù)字信號處理器，器件上集成了許多先進的外設(shè)，為電機及其他運動控制領(lǐng)域應(yīng)用的實現(xiàn)提供了良好的平臺。主頻高達300MHz，CPU高達32位，為系統(tǒng)實時運動控制提供了良好的運算能力。

2.2 電源模塊

　　開關(guān)電源輸出包含±15V及+5V電壓，其中，+15V與-15V用于為電機驅(qū)動模塊的運放供電，并通過選取合適的電容進行濾波。而控制芯片及外設(shè)硬件模塊均需3.3V電壓供電，該電壓屬于非常規(guī)電壓，采用電源芯片TPS75933將+5V的電壓轉(zhuǎn)換為+3.3V，最大輸出電流可達7.5A，3.3V電壓產(chǎn)生電路如圖2所示。

2.3 電機驅(qū)動模塊

　　電機驅(qū)動模塊用于控制和驅(qū)動力矩電機按照預(yù)定的控制指令運動，電機驅(qū)動模塊包括I/O轉(zhuǎn)換電路和D/A轉(zhuǎn)換電路。I/O轉(zhuǎn)換電路用于控制驅(qū)動器使能信號、驅(qū)動器綜合故障信號和驅(qū)動器就緒信號，D/A轉(zhuǎn)換電路通過輸出-10V~+10V控制驅(qū)動器產(chǎn)生相應(yīng)速度信號控制電機運動。

　　驅(qū)動器通過模擬電壓來響應(yīng)位置環(huán)與速度環(huán)的輸出，對應(yīng)于一定的模擬電壓驅(qū)動器輸出與之對應(yīng)的電流，控制力矩電機運動，從而實現(xiàn)對執(zhí)行機構(gòu)的精確控制。D/A轉(zhuǎn)換電路采用DAC7744芯片，該芯片具有16位分辨率，精度高，同時還能滿足-10V~+10V電壓輸出。在模擬量的輸出端施加運放隔離，既保證了DAC7744芯片的使用安全，也保證了輸出量的精度。

2.4 編碼器采集模塊

　　編碼器采集模塊用于接收編碼器實時反饋的反饋伺服機構(gòu)位置信息，編碼器采用進口的雷尼紹編碼器，型號為RGH20，5V供電。將編碼器安裝在轉(zhuǎn)臺的軸上，當(dāng)轉(zhuǎn)臺在運動時，編碼器會輸出差分信號，DSP會讀取這些信號。在設(shè)計接口電路時，需要將差分信號轉(zhuǎn)換為單端信號，且單端信號的高電平所對應(yīng)的電壓必須是3.3V，否則會損毀DSP芯片。差分轉(zhuǎn)單端的光耦型號是FOD063L，F(xiàn)OD063L屬于高速光耦，最大的轉(zhuǎn)換速度高達10MBit/s。轉(zhuǎn)換電路設(shè)計如圖4所示。

2.5 串口通訊模塊

　　串口通訊模塊用于控制器與管理計算機和跟蹤器通訊，上位機通過串口將控制指令發(fā)送給控制器，同時控制器將伺服機構(gòu)工作狀態(tài)及運動信息進行反饋。在此系統(tǒng)中，通訊主要采用422通訊與232通訊，422通訊芯片是MAX3490。此芯片一端連接與DSP的SCI接口連接，其中MAX3490以差分的422型與系統(tǒng)的上位機進行通訊。串口通訊模塊如圖5所示。

2.6 外部時鐘模塊

　　控制周期是采用外部的CPLD芯片，選用EPM570T100C5N，EPM作為系統(tǒng)的定時器，系統(tǒng)控制周期為1ms，EPM570T100C5N在完成1ms的定時后會輸出1個翻轉(zhuǎn)的電平信號，DSP采集作為外部中斷，實現(xiàn)轉(zhuǎn)臺的1ms實時控制。