陀螺穩(wěn)定平臺數(shù)字穩(wěn)定電路硬件設(shè)計與實現(xiàn)

黨宏濤,許孝敏,楊建業(yè),謝陽光 ,陳明淑

(1.西京學(xué)院理學(xué)院，西安 710123； 2.中國航空工業(yè)集團(tuán)公司西安飛行自動控制研究所，西安 710065)

0 引言

國外早期的慣性系統(tǒng)主要是基于轉(zhuǎn)子式陀螺的平臺慣導(dǎo)系統(tǒng)，在其關(guān)鍵的平臺穩(wěn)定回路中，自適應(yīng)控制等先進(jìn)控制理論和數(shù)字化、智能化控制技術(shù)得到成功應(yīng)用，平臺系統(tǒng)精度及綜合性能大幅提高[1]。在文獻(xiàn)[1]中，王巍院士在“慣性系統(tǒng)技術(shù)發(fā)展趨勢及展望”中提到“平臺式慣性系統(tǒng)需充分利用最新控制理論和控制技術(shù)來進(jìn)一步改善其穩(wěn)定回路的性能”。文獻(xiàn)[2-3]對慣性陀螺的基本原理及模擬電路進(jìn)行了敘述，是平臺穩(wěn)定回路數(shù)字化設(shè)計的基礎(chǔ)。文獻(xiàn)[4]對撓性石英加速度計的輸出進(jìn)行了A/D轉(zhuǎn)換電路的設(shè)計，提高了電路精度，具有很好的工程應(yīng)用價值。文獻(xiàn)[5]運用SI技術(shù)對慣性導(dǎo)航系統(tǒng)的數(shù)字電路進(jìn)行了設(shè)計，有效縮短了高速電路的研制周期，降低了研制成本。文獻(xiàn)[6-10]中設(shè)計了典型的高精度數(shù)據(jù)采集電路，具有重要的參考意義。很多文獻(xiàn)已對平臺數(shù)字回路的建模和控制算法的設(shè)計等進(jìn)行了系統(tǒng)的研究。文獻(xiàn)[11]對穩(wěn)定平臺系統(tǒng)進(jìn)行了建模，并進(jìn)行了比例積分微分(Proportion Integration Differentiation，PID)控制算法設(shè)計，使用PID算法對系統(tǒng)的快速性和穩(wěn)定性進(jìn)行調(diào)節(jié)，并對PID算法進(jìn)行了仿真。文獻(xiàn)[12]提出了采用以編碼器進(jìn)行數(shù)字測速構(gòu)成速度內(nèi)環(huán)、利用速率陀螺構(gòu)成速度外環(huán)的雙速度環(huán)復(fù)合控制方案。文獻(xiàn)[13]設(shè)計了跟瞄平臺俯仰回路的穩(wěn)定控制的模糊控制器；為了消除陀螺穩(wěn)定平臺系統(tǒng)中各框架間的耦合影響，文獻(xiàn)[14]設(shè)計了一種滑模非線性解耦控制算法；文獻(xiàn)[15]針對速率穩(wěn)定回路的校正環(huán)節(jié)設(shè)計中的超前滯后校正抗干擾性能差的缺陷，提出了兩種控制方法，改善了高階系統(tǒng)的動態(tài)性能。但數(shù)字硬件電路是各種算法能很好實現(xiàn)的基礎(chǔ)，基于此，本文針對某型陀螺穩(wěn)定平臺目前仍采用模擬穩(wěn)定電路的問題，設(shè)計并實現(xiàn)了陀螺穩(wěn)定平臺數(shù)字穩(wěn)定電路，主要研究了平臺數(shù)字穩(wěn)定電路的硬件實現(xiàn)問題。

1 總體設(shè)計思想

系統(tǒng)主要由模擬量采集、信號處理及功率放大三部分組成。具體電路包括電源電路、數(shù)字信號處理(Digital Signal Processing，DSP)電路、高精度模擬數(shù)字(Analogto-Digital，AD)采集電路、脈沖寬度調(diào)制(Pulse Width Modulation，PWM)驅(qū)動電路等，為后續(xù)各種先進(jìn)控制理論在數(shù)字回路中的應(yīng)用奠定基礎(chǔ)。數(shù)字穩(wěn)定回路驅(qū)動器使用了DSP平臺為核心控制器件，數(shù)字穩(wěn)定回路由控制部分和功率部分組成，功率部分為一個H橋拓補電路，受以DSP28335為核心控制器件的控制部分控制；控制部分包含1路PWM輸出、1路RS232通信口、1片256K×16的SRAM、1片256K×16的FLASH、8路ADC單端輸入以及4路ADC差分輸入。其中PWM信號經(jīng)過高速光耦后被傳輸?shù)紿橋的4個開關(guān)管，通過調(diào)節(jié)PWM脈沖寬度進(jìn)而調(diào)節(jié)直流母線經(jīng)過H橋輸出的電壓。

2 數(shù)字穩(wěn)定回路硬件設(shè)計與實現(xiàn)

2.1 電源電路

+28V的直流電通過電源電路后，變換出多路直流電壓供給DSP處理電路、AD采集電路及PWM驅(qū)動電路，電源電路原理如圖1所示。

圖1 電源電路原理圖Fig.1 Power supply circuit schematic diagram

2.2 DSP處理電路

DSP為TMS320F28335PGFA ，SARAM(片內(nèi)34K×16位、片外256K×16)，F(xiàn)LASH(片內(nèi)256K×16、片外256K×16)，PWM輸出，帶JTAG調(diào)試口。DSP處理電路原理圖如圖2所示。

2.3 AD采集電路

5V供電，ADS1256+低通濾波器+TI高性能基準(zhǔn)源芯片+低壓差低噪聲穩(wěn)壓芯片，8通道單端、4通道差分輸入，測量范圍(±5V、±2.5V、±1.25V、±0.625V、±0.3125V、±0.1563V、±0.0781V)，增益可調(diào)(1、2、4、8、16、32、64)，采集精度0.00001，采集速度30kSPS。AD采集電路原理圖如圖3所示。

2.4 PWM功放電路

輸出電壓28V，1通道，輸出功率可以控制5A以內(nèi)的直流負(fù)載(直流力矩電機，線圈阻值9～12Ω)，原理框圖如圖4所示。

圖2 DSP處理電路原理圖Fig.2 DSP processing circuit schematic diagram

圖3 AD采集電路原理圖Fig.3 AD acquisition circuit schematic diagram

圖4 PWM功放模塊原理框圖Fig.4 PWM power amplifier module principle block diagram

由S1、S2、S3、S4組成H開關(guān)，4個開關(guān)由電子元件構(gòu)成，通斷由功率驅(qū)動器驅(qū)動控制，S1、S4為一組，S2、S3為一組，2組開關(guān)不同時工作，控制力矩電機的電流方向，從而控制相應(yīng)框架軸的力矩方向。

當(dāng)輸出信號為0時，PWM方波正負(fù)脈沖寬度相等，流經(jīng)直流力矩電機的平均電流為0，電機產(chǎn)生力矩亦為0。當(dāng)功放輸入信號為正時，輸出方波正負(fù)脈沖寬度差動地變化(脈沖重復(fù)頻率不變)，平均電流為正，力矩電機產(chǎn)生正力矩；反之則為負(fù)。

圖5所示為PWM功放電路原理圖。

圖5 PWM功放電路原理圖Fig.5 PWM power amplifier circuit schematic diagram

3 實驗及結(jié)果分析

對數(shù)字穩(wěn)定回路的各個模塊分別進(jìn)行測試。測試內(nèi)容包含以下幾個部分：1)SRAM和FLASH測試；2)ADC輸入；3)RS232測試；4)H橋調(diào)制電壓測試。圖6所示為實物圖及測試現(xiàn)場。

(a)實物圖

(b)測試現(xiàn)場圖6 實物圖及測試現(xiàn)場 Fig.6 Photo of the circuit board and test site

將JTAG連接線插入JTAG1口，然后給數(shù)字穩(wěn)定回路通電，編寫程序?qū)RAM和FLASH進(jìn)行測試。測試先將SRAM和FLASH中的數(shù)據(jù)全部清零，然后依次向存儲區(qū)寫入數(shù)據(jù)，每個數(shù)據(jù)相較于前一個數(shù)據(jù)自增1，測試結(jié)果如圖7和圖8所示。

圖7 FLASH測試結(jié)果Fig.7 Flash test results

圖8 SRAM測試結(jié)果Fig.8 SRAM test results

測試完SRAM和FLASH之后，繼續(xù)對ADC進(jìn)行測試，測試ADC使用的是外部高精度基準(zhǔn)電壓，電壓值為3V，ADC通過P9接口輸入，此接口為單端輸入。測試結(jié)果顯示，ADC測量出的電壓為2.99691391V，如圖9所示。

圖9 ADC單端輸入測試結(jié)果Fig.9 ADC single input test results

數(shù)字穩(wěn)定回路上還有4路差分ADC輸入，同樣使用的是外部高精度基準(zhǔn)電壓，電壓值為3V，對其進(jìn)行測試，其中一路測試結(jié)果記錄如圖10所示。

圖10 ADC差分輸入測試結(jié)果Fig.10 ADC differential input test results

數(shù)字穩(wěn)定回路驅(qū)動器使用了RS232通信，通信接口為RS1，此測試只是簡單測試了驅(qū)動器的通信功能，實現(xiàn)驅(qū)動器返回上位機發(fā)出的信息內(nèi)容。使用串口線將驅(qū)動器和串口相連，將程序下載到驅(qū)動器之后運行，同時打開上位機，選擇一致的通信參數(shù)進(jìn)行數(shù)據(jù)發(fā)送，上位機成功收到了返回的數(shù)據(jù)。測試結(jié)果記錄如圖11所示。

圖11 RS232測試結(jié)果Fig.11 RS232 Test Results

PWM是電機驅(qū)動器中必不可少的脈沖控制信號，用于控制MOS管的開通和關(guān)斷。在數(shù)字穩(wěn)定回路中，PWM經(jīng)過高速光耦后傳遞給MOS管驅(qū)動芯片。測試過程中，對主控制器DSP進(jìn)行編程，產(chǎn)生一路100Hz，占空比為50%的PWM信號，然后用外用表測量P14口的輸出，測試結(jié)果為±13mV，滿足H橋計算理論結(jié)果。

4 結(jié)論

本文初步探索研究了某型陀螺穩(wěn)定平臺數(shù)字穩(wěn)定電路,用數(shù)字穩(wěn)定電路替代原有平臺的模擬穩(wěn)定電路。設(shè)計并實現(xiàn)了基于DSP的硬件電路,包括電源電路、24位高精度AD采集電路、DSP處理電路、H橋功率放大電路等。實驗結(jié)果表明，該硬件電路能滿足各種性能指標(biāo)要求。本文的研究成果為后續(xù)自適應(yīng)控制等先進(jìn)控制理論和數(shù)字化、智能化控制技術(shù)在陀螺穩(wěn)定平臺穩(wěn)定回路中的成功應(yīng)用奠定了硬件基礎(chǔ)。