O 引言
尋北儀在軍事和民用領(lǐng)域都有著廣泛應(yīng)用,它可測出載體縱軸與真北的夾角,用于為車輛、船舶等載體提供方位基準(zhǔn)。力矩電流發(fā)生器作為尋北儀的重要組成部分,地位極其重要,其作用是將計算機(jī)輸出的以數(shù)字量形式表示的方位和水平電流值轉(zhuǎn)換成模擬電流,分別輸入陀螺儀方位力矩器和水平力矩器,以產(chǎn)生找北力矩和阻尼力矩,使陀螺儀主軸跟蹤地理子午面的運動。
1 尋北儀微機(jī)控制系統(tǒng)
圖1給出了尋北儀微機(jī)控制系統(tǒng)的示意圖??刂朴嬎銠C(jī)完成對主體儀器的檢測和控制,同時負(fù)責(zé)顯示、鍵盤等人機(jī)交互內(nèi)容??刂朴嬎銠C(jī)通過串口獲取傾角傳感器姿態(tài)、航向發(fā)送器航向、計程儀/GPS航速等信息,利用ADT800模塊的A/D部分采集2路加速度計Az、Ay以及水平信號器Ey、方位信號器Ez等信息,定時解算控制電流并通過串口向其他設(shè)備發(fā)送航向信息。計算機(jī)解算得到的控制電流為數(shù)字形式,通過ADT800模塊的D/A部分輸出代表電流大小的電壓信號,通過壓控恒流源轉(zhuǎn)換為電流輸出,輸入到主體儀器的陀螺力矩器中,使陀螺跟蹤地理坐標(biāo)系。
2 力矩電流發(fā)生器硬件電路
2.1 總體結(jié)構(gòu)
根據(jù)尋北儀總體要求,控制電流有兩路,其中一路控制方位、一路控制水平,輸出控制電流的最大值為80 mA,最小值為0.5 μA,電流精度要求優(yōu)于O.5μA。如果不分檔,要滿足這樣大的范圍和高精度的要求,D/A轉(zhuǎn)換的分辨率應(yīng)為1 LSB=O.5×10-3/80=1/160 000(小于1/217而大于1/218),故需要18位的D/A轉(zhuǎn)換芯片,并要求有關(guān)電路具有百萬分之六的精度。為了降低對元器件的要求,將輸出電流分為2檔:取精電流的范圍為O~1.25 mA;而粗電流的范圍取為1.25~80 mA。分檔后對精電流精度的誤差要求為δ=O.5×10-3/1.25=O.000 4。若選取12位的D/A轉(zhuǎn)換芯片,其分辨率為1LSB=1/212=0.000 244,可見能滿足精度要求。為了進(jìn)一步提高轉(zhuǎn)換精度,采用電壓控制的恒流源向負(fù)載(陀螺力矩器線圈)提供電流。由于電流是恒流源,故它不會受負(fù)載變化以及電源波動等因素影響,保證了轉(zhuǎn)換精度。D/A輸出的電壓信號由計算機(jī)根據(jù)修正回路控制模型補(bǔ)償各種尋北儀誤差后解算控制輸出。設(shè)計的力矩電流發(fā)生器原理框圖如圖2所示。
2.2 壓控恒流源
壓控恒流源由運算放大器、場效應(yīng)管和晶體管等組成如圖3所示。恒流源輸出電流IL≈IO=UDACO/RO,與負(fù)載(陀螺力矩器線圈)電阻RL及電源電壓變化無關(guān),而只受輸入電壓控制,起到壓控恒流作用。恒流源電路難點在于其精度的提高及實現(xiàn),取決于元器件的選擇、印制板的設(shè)計編排、抗干擾措施的設(shè)計等因素。為此,運放采用低漂移、高精度的OP27,RO采用恒溫性好的精密電阻。因為是分兩檔進(jìn)行轉(zhuǎn)換,故當(dāng)進(jìn)行精粗轉(zhuǎn)換時,只要改變基準(zhǔn)電阻RO的數(shù)值即可,即在基準(zhǔn)電阻RO上并聯(lián)電阻小電阻RO1將精電流轉(zhuǎn)換為粗電流輸出。
2.3 開關(guān)電路
開關(guān)電路是力矩電流發(fā)生器電路的重要組成部分。恒流源只能輸出單方向的電流,用開關(guān)電路可以實現(xiàn)流人陀螺力矩器線圈的電流方向的改變;同時,恒流源的輸出電流分粗、精2檔,也要對其基準(zhǔn)電阻進(jìn)行切換。開關(guān)電路的理想程度將對系統(tǒng)性能產(chǎn)生較大的影響,特別是其不對稱性將造成系統(tǒng)零偏電流,為此要求開關(guān)電路有極高的響應(yīng)速度,一般至少在μs量級。為了提高電流輸出精度采用高速繼電器JRC-10M控制輸出電流的粗、精檔和正、負(fù)極性的轉(zhuǎn)換,由計算機(jī)通過控制ADT800的數(shù)字I/O口實現(xiàn)。由于修正回路修正電流的變化周期長,繼電器的壽命可以滿足系統(tǒng)要求。開關(guān)電路部分原理圖如圖4所示。R2為限流電阻,起保護(hù)作用。RO,RO1分別為粗、精電流控制電阻。PB3(PB5)控制繼電器J1(J3)實現(xiàn)水平(方位)力矩器電流的極性控制,PB4(PB6)控制繼電器J2(J4)實現(xiàn)水平(方位)力矩器電流的精粗控制。
2.4 ADT800模塊應(yīng)用
尋北儀中A/D、D/A、數(shù)字I/O功能的實現(xiàn)采用盛博公司的高速、高性能嵌入式數(shù)據(jù)采集和控制系統(tǒng)模塊ADT800,它具有24路TTL/CM-OS兼容的數(shù)字I/O口、4通道12位D/A輸出,完全可以滿足力矩電流發(fā)生器對D/A、數(shù)字I/O通道的要求,而且剩余通道還有利于系統(tǒng)的改進(jìn)與升級。
系統(tǒng)中,ADT800數(shù)字I/O地址為ADT800_BA+9,與力矩電流發(fā)生器有關(guān)的各位定義如圖5所示。
利用ADT800模塊D/A通道中的DAC0(DAC1)通道輸出的電壓信號控制方位(水平)壓控恒流源電路,實現(xiàn)對方位軸(水平軸)的控制。
3 力矩電流發(fā)生器軟件設(shè)計
考慮到尋北儀的應(yīng)用背景等因素,選擇DOS 6.22作為操作系統(tǒng),并選用UCDOS6.O作為漢字平臺。選用C++語言和Borland C++3.1集成開發(fā)環(huán)境為程序開發(fā)語言和開發(fā)環(huán)境,采用面向數(shù)據(jù)流的分析和設(shè)計方法對軟件進(jìn)行開發(fā)。采用多中斷和TSR技術(shù)增加軟件的實時性和多任務(wù)處理能力。
根據(jù)系統(tǒng)需求和模塊化的基本原則,將尋北儀軟件劃分為初始化模塊、管理模塊、定時中斷模塊和通訊模塊四大組成部分,如圖6所示。
與力矩電流發(fā)生器有關(guān)的軟件部分體現(xiàn)在初始化模塊和定時中斷模塊部分,包括ADT800的初始化、D/A控制和I/O控制。init_adt800()函數(shù)主要用于對ADT800模塊的初始化,包括A/D和D/A設(shè)置,初始化數(shù)字I/O口等。
定時中斷模塊根據(jù)處理得到的加速度計信號、計程儀/GPS航速信息、傾角傳感器姿態(tài)信息、鍵盤裝訂的參數(shù)、誤差補(bǔ)償量及系統(tǒng)所處的工作狀態(tài)等實時解算出陀螺控制電流,并向陀螺力矩器控制發(fā)送。
為了電流解算的方便,程序中定義了幾個數(shù)組:Kj[5],Ky[5],Kz[5],C1[5],C2[5],K2[5],K3[5],分別用于存放狀態(tài)轉(zhuǎn)換積分系數(shù)、方位控制回路的狀態(tài)轉(zhuǎn)換系數(shù)、水平控制回路的狀態(tài)轉(zhuǎn)換系數(shù)、C1系數(shù)、C2系數(shù)、方位控制放大器放大系數(shù)、水平控制放大器放大系數(shù)。由于最終力矩電流是通過壓控恒流源來實現(xiàn)的,因、此電流的解算就是得出相應(yīng)的控制電壓,解算程序如下(以羅經(jīng)狀態(tài)為例):
系統(tǒng)軟件除了完成上述的電流解算外,還要對工作狀態(tài)進(jìn)行切換。根據(jù)加表采樣值和dacy、dacz的大小及正負(fù),通過對ADT800_BA+9地址的置位/復(fù)位操作,實現(xiàn)力矩電流精粗和極性的控制,例如:
最后電流解算得到的對應(yīng)控制電壓通過ADT800的D/A通道輸出給壓控恒流源,經(jīng)V/I轉(zhuǎn)換后輸出至陀螺力矩器。實現(xiàn)D/A轉(zhuǎn)換的函數(shù)為:
例如,執(zhí)行語句adt800_da_out(ADT800_BA,0,Ddacy),即可實現(xiàn)向方位控制回路發(fā)送控制電壓,電壓值大小為Ddacy。
4 實驗
為了檢查力矩電流發(fā)生器所產(chǎn)生電流是否滿足精度性能要求,用Agilent E3620A直流穩(wěn)壓電源輸入表1中所示的電壓,在壓控恒流源輸出電路的負(fù)載端接上7.8 Ω的精密電阻作為負(fù)載模擬電機(jī)繞組,同時通過控制極性控制繼電器和精粗控制繼電器,改變輸出電流的極性和精粗,用Agilent 34401A數(shù)字萬用表測試流經(jīng)模擬負(fù)載的電流,所測結(jié)果如表1所示。
從表1所示的測試結(jié)果可以看出,針對尋北儀微機(jī)控制需要而設(shè)計的力矩電流發(fā)生器,其動態(tài)范圍較大,轉(zhuǎn)換精度優(yōu)于0.5 μA,可廣泛應(yīng)用于尋北儀、電控羅經(jīng)等慣性導(dǎo)航系統(tǒng)中。