楊宗霖,姚速瑞,張浩峰*(.南京理工大學(xué)計算機(jī)學(xué)院,南京0094; .南京理工大學(xué)機(jī)械工程學(xué)院,南京0094)
?
衛(wèi)星/慣性組合定位系統(tǒng)中的數(shù)據(jù)采集單元設(shè)計
楊宗霖1,姚速瑞2,張浩峰1*
(1.南京理工大學(xué)計算機(jī)學(xué)院,南京210094; 2.南京理工大學(xué)機(jī)械工程學(xué)院,南京210094)
摘要:介紹了一種衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)中的數(shù)據(jù)采集單元的設(shè)計過程及其測試結(jié)果。系統(tǒng)以低功耗單片機(jī)MSP430為控制器,并通過18 bit 8通道同步數(shù)據(jù)采集芯片AD7609采集三通道加速度計輸出,通過串口擴(kuò)展芯片XR16V554接收三通道數(shù)字化光纖陀螺的輸出數(shù)據(jù),由單片機(jī)串口接收GPS接收機(jī)的輸出數(shù)據(jù)。單片機(jī)將采集到的數(shù)據(jù)打包后,通過串口輸出給導(dǎo)航計算機(jī)進(jìn)行解算。測試表明:表征數(shù)據(jù)采集單元3個模/數(shù)轉(zhuǎn)換通道量化噪聲水平的1小時采樣數(shù)據(jù)的1σ標(biāo)準(zhǔn)差最大值為1.76 μg(@ 1 Hz),優(yōu)于待測加速度計偏置穩(wěn)定性(1小時采樣數(shù)據(jù)的1σ標(biāo)準(zhǔn)差)為50 μg(@ 1 Hz)的性能指標(biāo);數(shù)據(jù)采集單元同時能完成基于串口通信的陀螺輸出信號、GPS接收機(jī)輸出信號的接收及所有采集信號的正確傳輸。
關(guān)鍵詞:組合導(dǎo)航系統(tǒng);多通道數(shù)據(jù)采集系統(tǒng);多路串口擴(kuò)展; MSP430; GPS接收機(jī)
衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)因其優(yōu)良的性能,在軍用與商用導(dǎo)航領(lǐng)域得到了廣泛的應(yīng)用。衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)中的嵌入式計算機(jī)系統(tǒng)主要由數(shù)據(jù)采集單元與導(dǎo)航計算機(jī)兩部分組成。其中,數(shù)據(jù)采集單元的任務(wù)是:將采集到的慣性傳感器數(shù)據(jù)與GPS接收機(jī)輸出的數(shù)據(jù)傳送給導(dǎo)航計算機(jī)進(jìn)行導(dǎo)航解算,從而得到速度、位置、姿態(tài)等導(dǎo)航信息。作為衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)的信息來源,數(shù)據(jù)采集單元直接影響著組合導(dǎo)航系統(tǒng)的整體性能[1-3]。
論文討論的數(shù)據(jù)采集單元,主要實現(xiàn)對由三個軸向的電流輸出石英撓性加速度計及三個軸向的數(shù)字化光纖陀螺組成的IMU中的各個傳感器信號進(jìn)行數(shù)據(jù)采集,采樣率為100 Hz。石英撓性加速度計的量程為±10 gn,偏置穩(wěn)定性(1σ)為5×10-5gn(1 Hz采樣率) ;每個光纖陀螺通過各自的串口輸出傳感器敏感的角速率;系統(tǒng)同時能通過串口接收GPS接收機(jī)輸出的信息。
針對電流輸出型加速度計,以往大多采用專門設(shè)計的多通道I/F轉(zhuǎn)換電路將加速度計輸出的電流信號進(jìn)行I/F轉(zhuǎn)換,然后通過利用CPLD(或FPGA)設(shè)計的多通道計數(shù)器完成加速度計的數(shù)據(jù)采集[4-5];針對光纖陀螺的多串口接收,也常用CPLD(或FPGA)進(jìn)行多串口擴(kuò)展[6-7]。這些設(shè)計方案都能有效地完成數(shù)據(jù)采集任務(wù),但系統(tǒng)結(jié)構(gòu)相對復(fù)雜、通用性不強(qiáng),成本高,功耗大。
隨著微電子技術(shù)的飛速發(fā)展,速度快、精度高、體積小、功耗低成為組合導(dǎo)航系統(tǒng)硬件平臺的主要發(fā)展趨勢。在設(shè)計數(shù)據(jù)采集單元時,采用了低功耗高性能單片機(jī)MSP430作為控制器[8-9];根據(jù)需采集的加速度計的性能,采用I/V轉(zhuǎn)換+A/D轉(zhuǎn)換的方案代替?zhèn)鹘y(tǒng)的I/F轉(zhuǎn)換+6通道計數(shù)器的方案完成三軸加速度計輸出信號的采集;采用高集成性的串口擴(kuò)展芯片XR16V554接收3個軸向的數(shù)字化光纖陀螺的輸出數(shù)據(jù);通過單片機(jī)內(nèi)置的串口接收GPS接收機(jī)的輸出數(shù)據(jù);采集數(shù)據(jù)經(jīng)處理后通過串口發(fā)送給導(dǎo)航計算機(jī)。由于設(shè)計時采用的是集成度高、功耗低的通用電路,因此,系統(tǒng)結(jié)構(gòu)簡潔、成本低廉、功耗小,并能滿足數(shù)據(jù)采集的性能要求。
1.1三軸加速度計信號采集
針對前述衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)中IMU采用的加速度計的主要性能指標(biāo),設(shè)計的數(shù)據(jù)采集單元選用ADI公司具有過采樣機(jī)制的18 bit 8通道同步數(shù)據(jù)采集芯片AD7609對加速度計輸出信號進(jìn)行過采樣;初始采樣率為2 kHz,通過對20個采樣數(shù)據(jù)進(jìn)行平滑,得到100 Hz的導(dǎo)航解算用采樣數(shù)據(jù)。AD7609內(nèi)部8個輸入通道通過多路選擇開關(guān)共享一個模/數(shù)轉(zhuǎn)換器,但由于每個通道具有各自獨立的采樣保持器,因此通過使多通道同時從采樣狀態(tài)切換到保持狀態(tài)(然后再對各個通道進(jìn)行分時轉(zhuǎn)換),可以保證多通道信號的同時采集[10]。由于輸入是差分的,因此還能避免各通道共地造成的信號串?dāng)_。
1.2三軸陀螺信號采集及其他串行接口設(shè)計
與機(jī)械陀螺相比,光纖陀螺具有耐沖擊、長壽命、高分辨率、寬動態(tài)范圍、啟動時間短等突出優(yōu)點,已成為捷聯(lián)式慣性導(dǎo)航系統(tǒng)中理想的慣性器件[11-12]。衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)中的IMU采用的某型光纖陀螺采用數(shù)字輸出方式,通過UART輸出數(shù)字化信息,通信波特率為115 200 bit/s;幀格式為:偶校驗,8 bit數(shù)據(jù)位,1 bit停止位。三個軸向的陀螺信號采集,需要3個UART。
系統(tǒng)采用的GPS接收機(jī)為U-blox公司的GPS接收模塊LEA-5H,該模塊可通過USB或UART實現(xiàn)信息傳輸。由于采用UART傳輸信息已能滿足需要,為簡化設(shè)計,設(shè)計的數(shù)據(jù)采集單元采用UART與GPS接收機(jī)進(jìn)行通信。
在數(shù)據(jù)采集單元的設(shè)計過程中,采用了通過XR16V554擴(kuò)展多串口(UART)的方案來彌補(bǔ)數(shù)據(jù)采集單元中的控制器內(nèi)置UART數(shù)量不足的問題。通過擴(kuò)展XR16V554,可擴(kuò)展4個擁有16 byte接收/發(fā)送FIFO的UART。
1.3數(shù)據(jù)采集單元的總體方案
綜上所述,設(shè)計了如圖1所示的衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)中的數(shù)據(jù)采集單元結(jié)構(gòu)。
圖1 數(shù)據(jù)采集單元結(jié)構(gòu)框圖
由圖1可見,設(shè)計的數(shù)據(jù)采集單元主要由虛線框內(nèi)的AD7609、MSP430F247及XR16V554組成。
模數(shù)轉(zhuǎn)換器AD7609將經(jīng)I/V轉(zhuǎn)換后的加速度計模擬輸出數(shù)字化,并通過SPI接口將數(shù)據(jù)送給微控制器。微控制器通過總線方式訪問XR16V554,讀取通過3個UART接收的3個光纖陀螺輸出,而GPS接收機(jī)的輸出直接與微控制器的UART接收端相連。數(shù)據(jù)采集單元在微控制器的協(xié)調(diào)控制下,實現(xiàn)數(shù)據(jù)的采集、接收、打包等處理,最后將打包后的數(shù)據(jù)通過微控制器的UART的發(fā)送端發(fā)送給導(dǎo)航計算機(jī)。
2.1基于AD7609三軸加速度計信號采集
需采集的加速度計的標(biāo)度因數(shù)為1 mA/gn,因此其電流輸出范圍為±10 mA。由于AD7609各通道的輸入阻抗足夠大(大于1 MΩ),因此可考慮直接采用采樣電阻的方式實現(xiàn)I/V轉(zhuǎn)換。當(dāng)選擇AD7609模擬輸入范圍為±5 V時,可選擇500 Ω高精度取樣電阻并聯(lián)在AD7609的差分輸入端的方式實現(xiàn)I/V轉(zhuǎn)換,如圖2所示。這樣傳感器的滿量程與AD7609的滿量程一致,充分利用了AD7609的A/D轉(zhuǎn)換性能。
圖2 I/V轉(zhuǎn)換方案
通過AD7609的OS[2: 0]這3個引腳可以選擇AD7609的過采樣倍率,在最高過采樣倍率下(64倍率),A/D轉(zhuǎn)換的采樣率仍能達(dá)到3.125 ksample/s,足以滿足系統(tǒng)100 Hz的采樣率要求。設(shè)計時,通過使OS[2: 0]引腳配置成110,使其工作在64倍采樣率模式(以獲取最高的A/D轉(zhuǎn)換滿量程量化信噪比)。控制器通過控制AD7609的開始轉(zhuǎn)化信號CONVST A引腳啟動AD7609前4個通道的同時采樣過程;當(dāng)轉(zhuǎn)換完成后,通過AD7609的SPI接口讀取A/D轉(zhuǎn)換結(jié)果,完成一次三軸加速度計的數(shù)據(jù)采集。
AD7609自帶溫度系數(shù)為±10×10-6/℃的2.5 V基準(zhǔn)源。為使數(shù)據(jù)采集單元在寬溫范圍內(nèi)具有更好的性能,為AD7609配置了溫度系數(shù)更小的外部基準(zhǔn)源ADR421B(溫度系數(shù)為±3×10-6/℃)。同時對REFIN/REFOUT、REFCAPA和REFCAPB等引腳,通過10 μF電容進(jìn)行了去耦。
2.2基于XR16V554的三軸陀螺信號采集
采用XR16V554的Intel總線連接形式,通過地址引腳A[2: 0],微控制器可以選擇該芯片內(nèi)部的相關(guān)寄存器,寄存器尋址如表1所示。通過寄存器配置可進(jìn)行波特率選擇、FIFO工作方式選擇、使能中斷、讀取狀態(tài)標(biāo)志等操作。為匹配光纖陀螺串口速率,在外接14.745 6 MHz晶振時,通過配置前置脈沖分頻器(MCR bit-7 = 1),可得到115 200 bit/s的串口波特率。通過CSx引腳可以選擇相應(yīng)的串口通道。將INTx與控制器的GPIO引腳相連,在產(chǎn)生中斷后,通過判斷相關(guān)通道的狀態(tài),完成對應(yīng)通道的數(shù)據(jù)接收。
表1 XR16V554片內(nèi)寄存器地址
數(shù)據(jù)采集單元的軟件實現(xiàn)主要包括以下幾個方面:系統(tǒng)控制主流程,定時器中斷函數(shù),外部中斷函數(shù),串口中斷函數(shù)。
3.1系統(tǒng)控制主流程
圖3 系統(tǒng)控制主流程
系統(tǒng)控制的主流程如圖3所示。當(dāng)系統(tǒng)開始工作后,首先進(jìn)行各模塊的初始化。通過定時器初始化,配置定時器為增計數(shù)模式,使能定時器中斷,當(dāng)達(dá)到預(yù)定值便產(chǎn)生定時器中斷請求,系統(tǒng)進(jìn)入定時器中斷服務(wù)。通過SPI初始化,使控制器SPI工作在主模式,用以接收ADC采集到的加速度計信號。通過對擴(kuò)展串口芯片XR16V554的初始化,使其工作在FIFO模式,當(dāng)存儲的數(shù)據(jù)達(dá)到規(guī)定字節(jié)數(shù)后,相應(yīng)的INTx引腳向控制器發(fā)出中斷請求。通過初始化配置控制器的GPIO口,可以響應(yīng)XR16V554產(chǎn)生的中斷請求。最后配置控制器本身的串口,使其采用DMA模式向?qū)Ш接嬎銠C(jī)發(fā)送數(shù)據(jù)。接收端采用中斷模式,用以接收GPS接收機(jī)的輸出數(shù)據(jù)。在完成上述初始化工作后,為充分發(fā)揮MSP430低功耗特點,使系統(tǒng)處于低功耗0模式,等待中斷到來。若有中斷請求,控制器便從低功耗模式喚醒,轉(zhuǎn)而完成中斷服務(wù)。
3.2定時器中斷函數(shù)
定時器中斷函數(shù)執(zhí)行流程如圖4所示。定時器以0.5 ms為時間間隔周期性地產(chǎn)生中斷請求。在中斷子函數(shù)中,控制器首先發(fā)出觸發(fā)電平,用于啟動ADC的A/D轉(zhuǎn)換,隨后選通SPI通道,讀取模數(shù)轉(zhuǎn)換結(jié)果。為降低噪聲對A/D的影響,在2 kHz進(jìn)行A/D轉(zhuǎn)換時,采用了A/D轉(zhuǎn)換芯片自帶的過采樣技術(shù)。當(dāng)2 kHz的采樣率采集滿20個數(shù)據(jù)后,求取這20個數(shù)據(jù)的平均值,作為本次導(dǎo)航計算用的3個軸向的加速度信息(100 Hz)。得到導(dǎo)航計算用加速度信息的同時,微控制器向光纖陀螺發(fā)出觸發(fā)電平,使其通過串口輸出數(shù)字化的角速率信息由擴(kuò)展的串口芯片接收。當(dāng)控制器讀取接收到的3個軸向的角速率信息后,判別是否有更新的GPS導(dǎo)航信息,若有,更新GPS信息。最后以DMA方式通過控制器的串口輸出打包后的數(shù)據(jù)采集信息。
圖4 定時器中斷服務(wù)
3.3外部中斷函數(shù)與串口中斷函數(shù)
控制器通過判斷中斷信號來源確定擴(kuò)展的哪個UART完成了數(shù)據(jù)接收,從而確定讀取的數(shù)據(jù)來源于哪個光纖陀螺。隨后將接收到的數(shù)據(jù)存于相應(yīng)的內(nèi)存空間,直到接收完所有通道的數(shù)據(jù)后,改變標(biāo)志變量,表示三個軸向的陀螺輸出數(shù)據(jù)已接收完成。陀螺接收流程如圖5所示。
微控制器通過芯片內(nèi)嵌的UART接收GPS接收機(jī)輸出的信息,通過按序查找字符“MYM GPGGA”發(fā)現(xiàn)信息的幀頭,然后按照幀格式讀取幀中數(shù)據(jù)并存儲。
圖5 陀螺數(shù)據(jù)接收流程
設(shè)計完成的數(shù)據(jù)采集單元如圖6所示。
對設(shè)計完成的數(shù)據(jù)采集單元的測試,主要包括2個部分:一是3個通道的模擬信息的采集;二是數(shù)字信息的獲取及所有采集信息的發(fā)送。
圖6 數(shù)據(jù)采集單元實物
結(jié)合應(yīng)用背景,對3個通道的模擬信息采集的性能評估是這樣進(jìn)行的:將AD7609的3個A/D轉(zhuǎn)換通道的差分模擬輸入端短接,然后采集1 h數(shù)據(jù)。由于A/D轉(zhuǎn)換器是以2 kHz進(jìn)行A/D轉(zhuǎn)換然后平滑到100 Hz的,因此,將AD7609輸出的18 bit A/D轉(zhuǎn)換結(jié)果擴(kuò)展為32 bit,圖7中所示的是縱坐標(biāo)為32 bit二進(jìn)制表示時100 Hz采樣率下3個通道1 h采集到的碼值。由這些采樣數(shù)據(jù)計算得到的1 Hz 下3個通道的采集數(shù)據(jù)的1σ統(tǒng)計值,如表2所示。表中表征測量噪聲水平的1σ/232的最大值為8.8× 10-8,等價于8.8×10-8×(10-(-10) ) gn= 1.76 μgn。顯然優(yōu)于待測加速度計1σ偏置穩(wěn)定性為50 μgn的性能指標(biāo)(加速度計性能指標(biāo)中的偏置穩(wěn)定性定義為1 Hz采樣率下1 h采集數(shù)據(jù)的1σ統(tǒng)計值)。即設(shè)計完成的數(shù)據(jù)采集單元中的三通道模擬信號采集的噪聲水平比待測加速度計的噪聲水平低1~2個數(shù)量級,滿足設(shè)計要求。
在此基礎(chǔ)上,在數(shù)據(jù)采集單元的3個模擬量輸入通道接入3只某型石英撓性加速度計,100 Hz采樣率下3個通道1 h采集到的加速度值如圖8所示。1 Hz平滑后的1σ偏置穩(wěn)定性分別為57.8 μgn、39.5 μgn和43.9 μgn。
圖7 輸入端短路時3個通道1 h測試采樣值(@ 100 Hz)
圖8 3只石英撓性加速度計1 h測試采樣值(@ 100 Hz)
表2 3通道數(shù)據(jù)采集噪聲測試
對于數(shù)據(jù)采集單元中的三軸陀螺信號采集及其他串行通信接口,也進(jìn)行了單獨測試,并完成了系統(tǒng)總體調(diào)試,各部分均能按照設(shè)計的時序正常工作。由于此部分調(diào)試僅涉及數(shù)字信息傳輸而不涉及測量精度問題,因此不再列出具體的測試數(shù)據(jù)等細(xì)節(jié)。
針對衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)對數(shù)據(jù)采集單元提出的設(shè)計要求,設(shè)計了一種結(jié)構(gòu)簡單、通用性好、功耗低的數(shù)據(jù)采集單元。測試表明,設(shè)計完成的數(shù)據(jù)采集單元能實現(xiàn)對加速度計模擬輸出的采集與光纖陀螺、GPS接收機(jī)數(shù)字輸出信息的接收,采集到的數(shù)據(jù)能可靠地通過UART傳送給導(dǎo)航計算機(jī)進(jìn)行導(dǎo)航解算。當(dāng)采集單元中的AD7609替換成24 bitΣ-Δ型ADC時,文中介紹的數(shù)據(jù)采集單元可以在其他特性不變的前提下實現(xiàn)由更高精度的加速度計組成的衛(wèi)星/慣性組合導(dǎo)航系統(tǒng)的數(shù)據(jù)采集。
參考文獻(xiàn):
[1]劉剛,郭美鳳,張嶸,等.MIMU精度對GNSS/MINS組合導(dǎo)航系統(tǒng)性能影響仿真分析[J].中國慣性技術(shù)學(xué)報,2013,21(6) : 786-791.
[2]李枚,代剛,唐海林,等.一種高動態(tài)使用微慣性測量單元的實現(xiàn)[J].中國慣性技術(shù)學(xué)報,2012,20(2) : 127-135.
[3]趙志方,常佶.基于MEMS和CORTEX-M3的微慣性測量單元研制[J].微計算機(jī)信息,2011,27(7) : 75-76.
[4]劉飛,周衛(wèi)寧,林恒.捷聯(lián)慣導(dǎo)系統(tǒng)加速度計采集電路設(shè)計[J].電光與控制,2011,18(7) : 86-89.
[5]黃麗娟,邵志浩,鄭永強(qiáng),等.加速度計I/F變換電路數(shù)字補(bǔ)償方法[J].中國慣性技術(shù)學(xué)報,2014,22(4) : 547-551.
[6]徐玉丹,陶輝,秦龍,等.一種基于FPGA的芯片測試多通道串口擴(kuò)展設(shè)計[J].電子測量技術(shù),2013,36(3) : 89-93.
[7]張志文,彭彥.基于FPGA和NIOS的慣導(dǎo)組件測試測試系統(tǒng)研究[J].微處理機(jī),2014(1) : 85-89.
[8]Tang Yawei,Jiang Kai,F(xiàn)u Xiuquan,et al.Low Power Dual-Core Holter Systerm Based on MSP430 and ARM7[C]/ /3rd International Conference on Bioinformatics and Biomedical Engineering,2009: 1476-1478.
[9]Wang Chau-Chang,Hsiao Yu-Hung,Huang Min-Chih.Development of MSP430-Based Ultra-Low Power Expandable Underwater Acoustic Recorder[J].Ocean Engineering,2009,36(6-7) : 446- 455.
[10]朱欣華,鄒麗新,朱桂榮.智能儀器原理與設(shè)計[M].北京:高等教育出版社,2011: 43-44.
[11]王麗琴.光纖陀螺儀及其應(yīng)用[J].自動化與儀器儀表,2013 (5) : 132-135.
[12]Wang W,Wang X F,Xia J L.The Influence of Er-Doped Fiber Source under Irradiation on Fiber Optic Gyro[J].Optical Fiber Technology,2012,18(1) : 39-43.
楊宗霖(1983-),男,漢族,山東招遠(yuǎn)人,南京理工大學(xué)計算機(jī)學(xué)院學(xué)士,主要研究方向為計算機(jī)應(yīng)用技術(shù),13910847606@ 139.com;
張浩峰(1983-),男,漢族,江蘇淮安人,副教授,博士,研究方向為智能機(jī)器人、計算機(jī)視覺,zhanghf@ njust.edu.cn。
Design and Realization of the Telemetry System of Various Instruction Signals
ZHANG Huixin*,ZHANG Fengying,MA Rui,CUI Lijie
(National Key Laboratory For Electronic Measurement Technology,Key Laboratory of Instrumentation Science and Dynamic Measurement,Ministry of Education,North University of China,Taiyuan 030051,China)
Abstract:Aimed at test for the working status of aircraft accurately,a telemetry system was designed,which can provide various types of instruction signals.The logic control was completed by FPGA,and through Ethernet to communicate with the host computer,the speed of it can be 40 Mbit/s.On the basis of communication protocol combining with peripheral hardware,test parameters are provided for aircraft.The experimental results proved that the range of charged instruction signals produced by this system is stable,and the respond of non-charged instructions is accurate.This system has the advantages of reliability and interchangeability,which occupies a powerful practicality.
Key words:electric circuit; telemetry system; FPGA; Ethernet; W5300; instruction signals
doi:EEACC: 1230; 6210J10.3969/j.issn.1005-9490.2015.02.045
收稿日期:2014-11-24修改日期: 2014-01-04
中圖分類號:TN962
文獻(xiàn)標(biāo)識碼:A
文章編號:1005-9490(2015) 02-0452-06