MIMU/CSAC/BDS組合導航微系統(tǒng)的硬件設計*

陳德潘 陳 帥 樊龍江 孫昭行

南京理工大學自動化學院，南京210094

全球衛(wèi)星導航系統(tǒng)產(chǎn)業(yè)的迅猛發(fā)展改變了人們的生活方式[1]，中國自主開發(fā)研制的北斗衛(wèi)星導航系統(tǒng)在通信系統(tǒng)、應急指揮和交通管理等領域均發(fā)揮了巨大的作用。然而，衛(wèi)星導航系統(tǒng)存在的固有缺陷，使其在室內(nèi)、地下和水下等物理阻礙環(huán)境以及電子對抗等復雜電磁環(huán)境下的服務性能嚴重下降，甚至無法正常工作。因此，未來定位導航授時(Positioning，Navigation and Timing)應用技術發(fā)展的重點是如何實現(xiàn)具備抗干擾性強和精度高的PNT信息服務[2]。

最近幾年，國內(nèi)開展了以微機電技術(Micro-Electro-Mechanical Systems，MEMS)為核心的微慣性測量單元(MIMU)和芯片原子鐘(CSAC)的研究，其體積小、重量輕、成本低、功耗低、可靠性高和壽命長等優(yōu)勢，為微型化的組合導航系統(tǒng)的實現(xiàn)提供了可能[3-4]。

在此背景下，MIMU的輸出信息經(jīng)過解算可實時獲取載體的位置和速度信息，但是無法克服自身偏移誤差隨時間積累的缺陷[5]，需要北斗導航模塊進行校正。CSAC存在頻率偏移問題，導致其輸出結(jié)果偏離準確時間，因此需要北斗導航模塊輸出的1PPS(Pulse Per Second)修正誤差，同時提高北斗導航模塊授時精度[6]。本文設計了一種以MIMU、CSAC和BDS導航模塊為構架的組合導航微系統(tǒng)。充分分析了三者的接口設計與配置，三者的一體化設計提高了系統(tǒng)的可靠性和抗干擾能力。實驗表明：MIMU/CSAC/ BDS的組合導航微系統(tǒng)在真實跑車環(huán)境和高動態(tài)仿真環(huán)境下，可以正常工作，并輸出精度較高的性能指標。

1 MIMU/CSAC/BDS組合導航微系統(tǒng)的總體設計方案

MIMU/CSAC/BDS的組合導航微系統(tǒng)總體方案設計如圖1所示。主要從以下4個部分介紹：

1)微慣導模塊：微慣導模塊利用MIMU中陀螺測得的角速率、加速度計輸出的比力經(jīng)過誤差補償后，通過串口發(fā)送給數(shù)據(jù)處理單元，采用導航算法解算獲取位置、速度、加速度和姿態(tài)等導航信息。最后將數(shù)據(jù)傳送給組合導航模塊、通信接口模塊和慣性輔助模塊；

2)CSAC模塊：CSAC可提供精確的時鐘信息。CSAC和處理器通過串口通信，串口通信功能包括查詢測量數(shù)據(jù)、頻率調(diào)節(jié)及查詢、設置/清除操作狀態(tài)、芯片原子鐘自動同步和1PPS馴服設置等；

3)BDS定位導航模塊：BDS定位導航模塊需要獲取衛(wèi)星信號相關器中鎖存的多普勒頻移信息、載波相位信息和導航電文等信息，通過解析得到星歷、偽距和偽距率等信息，計算出當前載體的位置、速度以及時間信息；

4)組合導航模塊：組合導航微系統(tǒng)中，CSAC提供精準的時間基準，MIMU經(jīng)慣導解算得到的載體位置、速度信息與北斗衛(wèi)星的位置、速度信息進行計算得到載體的偽距、偽距率；與此同時北斗定位導航模塊解算可直接得到偽距、偽距率，將兩者的信息進行基于偽距、偽距率差的卡爾曼組合濾波，得到載體的位置、速度及姿態(tài)誤差，對系統(tǒng)進行修正，得到高精度的導航定位信息。

2 MIMU/CSAC/BDS組合導航微系統(tǒng)的硬件設計

組合導航微系統(tǒng)的硬件結(jié)構是由微慣性測量單元、芯片原子鐘模塊和DSP+ FPGA為核心的北斗導航模塊組成。要實現(xiàn)組合導航微系統(tǒng)的功能，必須確定各個模塊與DSP+FPGA之間的配置與接口設計，充分利用各個模塊的資源。組合導航微系統(tǒng)的硬件設計結(jié)構圖如圖2所示。

圖2 組合導航微系統(tǒng)硬件設計結(jié)構圖

2.1 MIMU的硬件特征與配置設計

本系統(tǒng)采用的MIMU為本團隊自主研發(fā)。MIMU的設計由4個部分組成，分別為慣性傳感器模塊、溫度傳感器模塊、數(shù)字處理單元和減振系統(tǒng)。其中，慣性傳感器模塊由三軸MEMS加速度傳感器芯片和三軸MEMS陀螺儀傳感器芯片兩兩正交組成，完成載體坐標系軸的加速度及角速度測量。同時，在慣性器件ASIC(專用集成電路)上集成溫度傳感器，可以測量環(huán)境溫度，以用于對每個軸的零偏和標度進行溫度補償，同時對兩兩軸向間的交叉耦合也進行補償，提高其綜合測量精度。數(shù)字處理單元中的3個角速度通道的輸出、3個加速度通道的輸出、溫度信號及補償信號用來進行誤差補償、數(shù)字濾波、劃船效應和圓錐效應處理，以此提高慣性器件的使用精度。而減振系統(tǒng)可以保證良好的防振動和沖擊的能力。

MIMU提供由微陀螺儀和微加速度計測量出的角速率信息和加速度信息，其采用J30J-15ZKP型矩形連接器，MIMU與處理器的連接圖如圖3所示。

MIMU對外通信采用RS-422 接口，輸出的最大波特率為921600bps，數(shù)據(jù)更新頻率最大為1000Hz，工作電壓為5V，陀螺儀的零偏穩(wěn)定性≤10°，加速度計的零偏穩(wěn)定性≤0.1mg。通過RS-422接口將數(shù)據(jù)發(fā)出，經(jīng)DSP處理芯片，進行組合導航信息融合。

2.2 CSAC的硬件特征與配置設計

CSAC可為組合導航微系統(tǒng)提供準確的時鐘基準。本系統(tǒng)采用的XHTF1040型CPT微型原子鐘，該原子鐘具有尺寸微型化45×36×15 (mm3) 、+3.3V低電壓供電且功耗低等特點。其外秒同步功能：1PPS同步精度優(yōu)于50ns；外秒馴服精度≤5E-12(馴服1天后24小時平均值)；保持性能≤5us(馴服1天后24小時保持時差)。CSAC頻率準確度比普通的溫補型晶振的頻率準確度高出3～4個數(shù)量級，因此當采用CSAC作為衛(wèi)星信號接收機的時鐘信息源時，可認定接收機的時鐘頻率在相當長的一段時間里保持穩(wěn)定的狀態(tài)[7]。因為北斗衛(wèi)星接收機每一次解算出來的鐘差都是相互獨立的，因此，可以把一段時間內(nèi)接收機正常定位時獲取的鐘差信息記錄成歷史數(shù)據(jù)，根據(jù)記錄的歷史鐘差信息建立鐘差模型，并對后續(xù)一段時間內(nèi)的鐘差信息做出準確的預測。北斗衛(wèi)星接收機的時鐘Tbd與系統(tǒng)時Ts的關系可以寫成：

Tbd-Ts=α0+α1(Ts-t0)+α2(Ts-t0)2

(1)

(2)

(3)

上式可以寫成：

這下，馱子與常愛蘭才反應過來，然后趕緊把李老師迎進屋子里。屋子里的凌亂是李老師能夠想象得到的。在農(nóng)村，家里收拾得很干凈的不太有，更何況是彈棉花的人家，更何況是外鄉(xiāng)人。

Tbd-Ts=Rα

(4)

其中：α0，α1，α2分別為相對偏差、鐘速和鐘漂信息，t0為參考歷元信息。

(5)

CSAC提供的10MHz頻率，結(jié)合通過天線接收北斗衛(wèi)星1561.098MHz的載波頻率，經(jīng)過濾波和放大后，再通過混頻下變頻成中頻信號，最后由A/D芯片采樣，將模擬中頻信號離散化成數(shù)字中頻信號給FPGA處理。中頻信號產(chǎn)生流程圖如圖4所示。

圖4 中頻信號產(chǎn)生流程圖

芯片原子鐘模塊能夠提供精準的1pps秒脈沖和精準的時鐘信號，經(jīng)過馴服后，可獨立提供精準的1pps秒脈沖供導航處理器使用，實現(xiàn)獨立授時功能[8]。該模塊與導航模塊數(shù)據(jù)處理單元的DSP數(shù)據(jù)通信采用RS232串口進行數(shù)據(jù)傳輸，DSP通過讀取RS232中的數(shù)據(jù)可以實時觀測芯片原子鐘的溫度、馴服狀態(tài)及鎖定時間等狀態(tài)；衛(wèi)星導航模塊定位后會輸出一個基準的秒脈沖，將該秒脈沖輸出給芯片原子鐘的“1pps_IN”管腳，引入后來馴服原子鐘的1pps秒脈沖；芯片原子鐘馴服后輸出的1pps秒脈沖經(jīng)過中斷的方式被DSP讀取，來輔助衛(wèi)星導航模塊，提高時間精度；芯片原子鐘提供一個精準的HCMOS電平信號，將該信號接入到射頻單元與FPGA單元代替原有的溫補型晶振，能夠提供更精準的頻率，減少了衛(wèi)星導航模塊本身造成的鐘差。芯片原子鐘與處理器連接圖如圖5所示。

圖5 芯片原子鐘與處理器連接圖

本系統(tǒng)射頻模塊選用Maxim Integrated公司的MAX2769[9]。對MAX2769進行初始化配置，設置NDIV值為2491，RDIV值為16，進行中心頻率推算：

(6)

fB1=1561.098MHz

(7)

fLO=NDIV×f=2491f

(8)

fbdcen=1561.098MHz-2491f=4.223MHz

(9)

其中，fCSAC表示原子鐘頻率，fB1表示B1載波頻率，fbdcen表示中心頻率。

2.3 北斗導航模塊的硬件特征與配置設計

北斗導航模塊是基于DSP+FPGA的，其主要硬件部分包括射頻前端處理模塊、基帶信號數(shù)字處理模塊和定位解算模塊。射頻前端處理模塊對衛(wèi)星信號進行放大、變頻、濾波和模數(shù)轉(zhuǎn)換，得到數(shù)字中頻信號；基帶信號數(shù)字處理模塊對數(shù)字中頻信號進行捕獲、跟蹤、位同步和幀同步處理，得到導航測量值和導航電文；定位解算模塊利用導航測量值和導航電文進行定位解算，最終得到用戶的位置信息，獲取定位觀測值。

北斗系統(tǒng)射頻模塊選用Maxim Integrated公司的MAX2769，MAX2769芯片內(nèi)集成的Σ-ΔN分頻頻率合成器可實現(xiàn)±40Hz精度的中頻編程，從而能夠與主機系統(tǒng)所提供的任意基準或晶體頻率配合工作，使得北斗系統(tǒng)射頻模塊僅需少量外部元件，即可構建完整的低成本接收機方案，符合當前低功耗、高集成度、小尺寸、低價格的發(fā)展潮流。

EP4CE115F23C8N是Altera公司Cyclone系列的第四代產(chǎn)品[10]，采用臺灣半導體生產(chǎn)公司(TSMC)的60nm低功耗(LP)工藝技術。其具有低功耗、低成本和高性能的特點。FPGA利用配置的I/O口讀取MAX2769處理過的數(shù)字中頻信號，并將信號傳送到通道相關器進行處理，累加器將I/Q信號進行鎖存并觸發(fā)累加中斷；TIC鎖存器鎖存相關量并觸發(fā)TIC中斷，同時輸出1PPS秒脈沖。整體結(jié)構設計分為：時鐘時基發(fā)生器、數(shù)據(jù)重采樣模塊、相互獨立的通道模塊、寄存器組模塊等。FPGA中采用多通道并行接收衛(wèi)星信號，通道中的相關器的每個通道占用資源為750LE，與其他不倍頻純使用LE實現(xiàn)同類功能的相關器代碼相比，優(yōu)化程度很高。FPGA內(nèi)部相關器結(jié)構圖如圖6所示。

圖6 FPGA內(nèi)部相關器結(jié)構圖

定位解算及信息融合處模塊采用的是TI(Texas Instruments)公司的定點/浮點數(shù)字信號處理器TMS320C6747[11]，主頻高達300MHz，擁有豐富的外圍模塊，外形尺寸僅為17mm×17mm。它的內(nèi)核使用了兩級緩存結(jié)構，分別是32KB一級程序緩存(LIP)和32KB一級數(shù)據(jù)緩存(LID)；256KB二級程序或數(shù)據(jù)存儲器(L2RAM)。同時第二級(L2)還可以訪問一個1024KB集成ROM。當DSP進行導航解算時，F(xiàn)PGA剝離數(shù)字中頻信號包含多普勒頻移在內(nèi)的載波和偽碼，DSP讀取導航電文。北斗導航模塊信號流程圖如圖7所示。

圖7 北斗導航模塊信息流程圖

DSP的EMIFA接口通過數(shù)據(jù)總線和地址總線與FPGA配置好的數(shù)據(jù)總線和地址總線相連，其中數(shù)據(jù)總線長度為16位，使用數(shù)據(jù)線EMA_D [15:0]與FPGA的D[15:0]連接。地址總線長度為12位，由于每次讀寫數(shù)據(jù)的長度為2個字節(jié)，在地址總線中最低位恒為0，DSP使用地址線EMA_A[11:1] 與FPGA的A[11:1]連接。地址中高5位產(chǎn)生通道選擇信號，低6位是每個通道內(nèi)寄存器的偏移地址。DSP與FPGA總線連接圖如圖8所示。

圖8 DSP與FPGA總線連接圖

3 MIMU/CSAC/BDS組合導航微系統(tǒng)的底層硬件驅(qū)動設計

組合導航微系統(tǒng)的處理器底層驅(qū)動設計主要包含系統(tǒng)時鐘驅(qū)動程序設計和中斷驅(qū)動程序設計。

北斗接收機和CSAC能夠輸出高精度的整秒時間，但時間輸出頻率比較低，不能滿足組合導航算法中對精確時間的需求。DSP的定時器模塊無法進行時間修正，本系統(tǒng)結(jié)合CSAC精確的時間信息、定位解算出的時鐘鐘差信息和DSP本身的定時器，設計了一個高精度的系統(tǒng)時間模塊，其工作流程如圖9所示。接收機僅在定位解算后，利用自身的衛(wèi)星時間和CSAC馴服后的整秒時間，計算得到定時器時間的誤差量用來修正定時器時間。

圖9 系統(tǒng)時間模塊工作流程圖

組合導航微系統(tǒng)中斷設置如表1所示。

表1 中斷設置表

DSP的中斷方式基本利用事件觸發(fā),為保證組合導航微系統(tǒng)的實時性，對性能要求高的功能模塊均采用中斷服務子程序的方式進行處理。

4 實驗測試

為了驗證本原理樣機的可行性，將原理樣機各部分調(diào)試完成后，與軟件配合進行地面跑車(低動態(tài))實驗和高動態(tài)模擬器實驗。

跑車實驗選擇在南京市開發(fā)區(qū)路段進行。出發(fā)點緯度是32.0273629°，經(jīng)度118.8957339°，高度是13.537m。在出發(fā)點通過尋北儀測得慣導前向與北向的夾角為150°，則初始偏航角設置為150°。采用高精度組合導航系統(tǒng)作為基準。在實驗中使用監(jiān)控軟件實時采集系統(tǒng)輸出的信息并存入文件，并對實驗數(shù)據(jù)進行處理分析，比較得出誤差。實驗結(jié)果如圖10～11所示。

圖10 組合導航微系統(tǒng)速度誤差

圖11 組合導航微系統(tǒng)位置誤差

從圖10～11中得出，緯度誤差2.99m(1σ)，經(jīng)度誤差3.05m(1σ)，高度誤差8.72m(1σ)，東向速度誤差0.08m/s(1σ)，北向速度誤差0.12m/s(1σ)，天向速度誤差0.15m/s(1σ)。跑車實驗結(jié)果表明，組合導航微系統(tǒng)在真實的環(huán)境下能為載體提供良好的定位信息，符合設計要求。

高動態(tài)模擬器實驗采用衛(wèi)星導航信號模擬器仿真載體的高動態(tài)飛行軌跡，并基于組合導航微系統(tǒng)中使用的接收機搭建半實物仿真系統(tǒng)，軌跡設定為大圓軌跡，半徑為600km。載體不斷作加速和減速運動，速度和加速度按正弦變化。最大速度為8km/s，最大加速度為50g。仿真軌跡圖、線速度和線加速度如圖12～13所示。

圖12 仿真軌跡圖

圖13 軌跡線速度與加速度圖

實驗結(jié)果如圖14～15所示，與原始軌跡比較，組合導航微系統(tǒng)的緯度誤差為0.48m(1σ)，經(jīng)度誤差為1.07m(1σ)，高度誤差為2.25m(1σ)，東向速度誤差為0.32m/s(1σ)，北向速度誤差為0.32m/s(1σ)，天速誤差為0.11m/s(1σ)。實驗結(jié)果表明組合導航微系統(tǒng)在高動態(tài)環(huán)境下性能指標良好，符合設計要求。

圖14 組合導航微系統(tǒng)速度誤差

圖15 組合導航微系統(tǒng)位置誤差

5 結(jié)論

提出了1種MIMU/CSAC/BDS組合導航微系統(tǒng)的設計方案，并由此完成了組合導航微系統(tǒng)的硬件和底層驅(qū)動設計與實現(xiàn)工作。該組合導航微系統(tǒng)具有功耗低和體積小等特點，易于載體安裝。經(jīng)過多次測試，實驗表明：組合導航微系統(tǒng)能夠為用戶在真實環(huán)境下提供準確的位置和速度信息。此外，組合導航微系統(tǒng)具有良好的跟蹤性能與導航精度，在高動態(tài)環(huán)境下亦可提供準確的位置和速度信息。本文設計的組合導航微系統(tǒng)應用場景以軍民兩用為背景，在無人機車和衛(wèi)星、火箭、導彈等高動態(tài)載體相關場景下具有良好的發(fā)展前景。

參 考 文 獻

[1] 李旭,李為民.美俄軍事衛(wèi)星系統(tǒng)發(fā)展現(xiàn)狀與趨勢[J]. 國防科技，2015(2):43-48. (Li Xu，Li Weimin. Development Status and Trend of American and Russian Military Satellite Systems [J]. Defence Technology, 2015(2):43-48.)

[2] 江城,張嶸.美國Micro-PNT發(fā)展綜述[J].中國衛(wèi)星導航學術年會,2015. (Jiang Cheng, Zhang Rong. The General Development of the United States Micro-PNT [J]. China Satellite Navigation Conference, 2015.)

[3] 劉鈍,甄衛(wèi)民,張風國,歐明.PNT系統(tǒng)體系架構與PNT新技術發(fā)展研究[J]. 全球定位系統(tǒng), 2015(2): 48-52. (Liu Dun, Zhen Weimin, Zhang Fengguo , Ou Ming. PNT System Architecture and PNT Study on the Development of New Technologies [J]. Global Positioning System, 2015(2): 48-52.)

[4] 楊元喜.綜合PNT體系及其關鍵技術[J].測繪學報,2016,45(5):505-510. (Yang Yuanxi. Comprehensive PNT System and Its Key Technology [J]. Journal of Surveying and Mapping, 2016,45(5): 505-510.)

[5] Barbour N,Schmidt G.Inertial Sensor Technology Trends[J]. IEEE Sensors Journal,2001,1(4): 332-339.

[6] 王淑華.國外CPT CSAC技術發(fā)展現(xiàn)狀 [J].微納電子技術,2016,53(3) :137-145. (Wang Shuhua. Foreign Technology Development of CPT CSAC [J]. Micronanoelectronic Technology, 2015(2): 48-52.)

[7] 汪中.Review of Chip-Scale Atomic Clocks Based on Coherent Population Trapping[J].中國物理,2014, 23(3):47-58.(Wang Zhong. Review of Chip-Scale Atomic Clocks Based on Coherent Population Trapping[J]. Chinese-Physics, 2014, 23(3): 47-58.)

[8] 趙令令,陳優(yōu).CPT原子鐘的概念及發(fā)展[J].中國科技術語,2014(s1).(Zhao Lingling, Chen You. Concept and Development of CPT Atomic Clock [J].Chinese Science and Technology Terms Journal ,2014 (11).)

[9] Wang Yue. GPS Software Receiver Based on MAX2769[J].Journal of Hebei University of Engineering,2012(3).

[10] Wang Hua, Chang Jing, Qin Changlu, Tian Xiang. An Implementation Scheme of GNSS Signal Simulator Based on DSP and FPGA [J] .Computer Science and Service System(CSSS), 2011:1080-1083.

[11] Yang Chun, Chen Qingwei, Zhang Ruilei, Zhang Lei. Design and Implementation of Integrated Navigation System Based on DSP [J]. Control Conference, 2014, 74(5-1):528-533.