陳 凱，王廣龍，王 成

(1.66008部隊，天津 300250；2.軍械工程學院納米技術與微系統(tǒng)實驗室，河北 石家莊 050003)

基于北斗/iNEMO的航姿測量系統(tǒng)設計

陳 凱1，王廣龍2，王 成2

(1.66008部隊，天津 300250；2.軍械工程學院納米技術與微系統(tǒng)實驗室，河北 石家莊 050003)

基于北斗接收機和iNEMO慣性傳感器模塊，設計了一種可用于載體運動姿態(tài)方位解算的傳感信息采集微系統(tǒng)。針對兩個導航單元存在輸出數(shù)據(jù)格式、速率和接口完全不同的問題，采用雙CPU+FPGA+Flash的硬件架構(gòu)，并由兩個處理器協(xié)同工作完成了多路大容量導航參數(shù)的實時采集、處理和存儲。同步計數(shù)器將北斗輸出的1PPS脈沖作為清零信號，同時考慮到iNEMO沒有固定的時間參考系，在iNEMO數(shù)據(jù)中加入北斗時標信息，由硬件邏輯電路實現(xiàn)了子單元數(shù)據(jù)在整秒時刻的同步。試驗驗證了北斗1PPS秒脈沖信號的同步偏差不會影響后續(xù)濾波的精度，且該模塊能穩(wěn)定地輸出帶時間標記的三軸加速度、陀螺傳感器和磁傳感器數(shù)據(jù)。通過解算可得到載體位置、速度、姿態(tài)等信息。該系統(tǒng)體積小、功耗低、魯棒性好，設備可重復使用，不僅能夠滿足單一飛航裝備測試的要求，還可以結(jié)合多傳感器信息融合技術，進一步提高多目標導航定位的時空精度。

北斗系統(tǒng); 嵌入式系統(tǒng)； 傳感器； 無人機； 遙感技術； FPGA; 時間同步

0 引言

在導彈、制導炮彈、無人機等飛航裝備的研制和生產(chǎn)過程中，都需要對其飛行方位和姿態(tài)進行實時動態(tài)測試[1]。而現(xiàn)在普遍采用的遙測技術是一種間接測量方式，遇到山脈等遮蔽物時會丟失目標，無法實現(xiàn)全空域跟蹤；空間電磁波的干擾會降低其測試精度，且傳輸帶寬的限制也會導致載體自身的大量數(shù)據(jù)無法實時回傳。存儲測試的方式是：將飛行過程中各傳感器的輸出量采集存儲到介質(zhì)中，事后回收并由計算機處理和再現(xiàn)測試信息。試驗飛行范圍不受限制，無需布設大量的遙測臺，用來輔助測量的地面設備少[2-3]。而任何單一測量系統(tǒng)在精度、可用性、可靠性等方面都存在一定的缺陷，因此各類組合式測量系統(tǒng)成為存儲測量的主要發(fā)展方向。捷聯(lián)慣性/衛(wèi)星組合系統(tǒng)是目前軍民領域應用廣泛的一種高精度、低成本導航系統(tǒng)[4-6]。

我國自主研發(fā)的“北斗二代衛(wèi)星導航系統(tǒng)”的測量精度已與GPS處在同一水平[7-8]，其接收機在功耗、體積等方面也能滿足嵌入式系統(tǒng)的要求[9]。iNEMO慣性模塊是一種基于微機電系統(tǒng)(micro electro mechanical system,MEMS)技術的微型慣性測量單元。但不同于一般的慣性測量單元，其輸出數(shù)據(jù)為全數(shù)字信號，不再需要進行A/D轉(zhuǎn)換，極大地降低了設計的復雜度[10-12]。

本文在北斗接收機和iNEMO慣性傳感器模塊這兩個測量單元的基礎上，采用存儲測試的方式，設計并實現(xiàn)了一種大容量導航數(shù)據(jù)實時采集處理與存儲系統(tǒng)，以滿足裝備測試微型化、低成本、集成化的要求。

1 系統(tǒng)總體設計

系統(tǒng)由北斗接收機、iNEMO慣性模塊、主/從處理器、FPGA、無線指令模塊等組成，采用雙CPU+FPGA+Flash的硬件架構(gòu)。系統(tǒng)總體框圖如圖1所示。

圖1 系統(tǒng)總體框圖

由于北斗接收機和iNEMO慣性模塊兩個導航單元的輸出數(shù)據(jù)格式、速率和接口完全不同，使用兩個處理器(CPU)分類采集信號，能提高程序執(zhí)行效率。FPGA可以很方便地實現(xiàn)時序邏輯電路功能。

測試系統(tǒng)的啟動指令可由遠端監(jiān)控站通過無線方式發(fā)送或者由被測載體自身通過點火等信號進行觸發(fā)。系統(tǒng)工作時，北斗接收機由UART接口每秒輸出一次1PPS定時信號和NEMA0813導航信息，iNEMO慣性模塊由SPI接口輸出實時測得的線性加速度、角速度和磁場強度三個分量的原始數(shù)據(jù)。協(xié)處理器從北斗接收機輸出的導航信息中提取有效信息并暫存入FPGA中。FPGA包含一個雙口RAM存儲器和一個高精度的計數(shù)器。雙口RAM存儲器通過可變靜態(tài)存儲控制器(flexible static memory controller,FSMC)總線，實現(xiàn)主從處理器間的數(shù)據(jù)交換。為防止北斗/iNEMO慣性模塊存在的時標差隨系統(tǒng)工作時間的遞增而累積，計數(shù)器將北斗輸出的1PPS脈沖作為清零信號，同時考慮到iNEMO沒有固定的時間參考系，需要向iNEMO數(shù)據(jù)加入北斗時標信息，并將其轉(zhuǎn)化到北斗時間基準中，從而實現(xiàn)兩個子單元數(shù)據(jù)在整秒時刻同步[13-14]。

為保障各個器件的協(xié)同工作，同時考慮到時鐘驅(qū)動電流的限制，有源晶振的Clock信號作為系統(tǒng)唯一的頻率基準輸出到FPGA中，由FPGA對其分頻，為各器件提供時鐘。主處理器負責系統(tǒng)的總體控制和測試數(shù)據(jù)融合，并根據(jù)FPGA的觸發(fā)信號產(chǎn)生中斷，讀取有效的北斗導航信息、iNEMO慣性模塊時標信息和原始數(shù)據(jù)，在若干讀寫周期之后將數(shù)據(jù)存入Flash中。完成測試后，對設備進行回收。數(shù)據(jù)處理終端通過USB接口讀取儲存于Flash中的數(shù)據(jù)并進行解算。

2 系統(tǒng)硬件設計

2.1 北斗和iNEMO慣性模塊

北斗接收機采用和芯星通公司的UM220-III N芯片，這是一種北斗/GPS雙系統(tǒng)模塊，能夠同時支持 BD2 B1、GPS L1 兩個頻點。定位精度(均方根值)為2.5 m，測速精度(均方根值)為0.2 m/s(北斗)、0.1 m/s(GPS/雙模)，1PPS同步精度(均方根值)為20 ns。采用UART接口輸出NMEA0183格式的ASCⅡ碼，數(shù)據(jù)更新率為1 Hz。

第四，文化重視程度不同。隨著時代的進步，世界文化的交流的日益密切，越來越多的中國人選擇了學習西方國家的飲食方式，并且由于日常工作的繁忙，人們進入了“快餐時代”，漸漸地忘記了中國優(yōu)秀傳統(tǒng)文化的傳承，許多的優(yōu)秀文化在逐漸被遺忘，而韓國卻十分的注重傳統(tǒng)文化的繼承與發(fā)展，相比較于中國韓國對文化的重視程度更高，對人們禮節(jié)上的要求更為嚴格。

iNEMO慣性傳感器模塊采用的是意法半導體(ST)公司的LSM9DS1芯片。該芯片是基于MEMS工藝的9軸運動位置傳感器模塊，內(nèi)置一個3軸加速度計、一個3軸陀螺儀和一個3軸磁強計。這3種傳感器分別檢測線性加速度、角速度和磁場強度，滿量程輸出分別為±16 g、±2 000 (°)/s、±16 gauss，輸出數(shù)據(jù)速率(output data rate,ODR)可調(diào)，加速度計/陀螺儀ODR最高可達952 Hz，磁強計ODR最高可達80 Hz。采用SPI或I2C輸出16 bit數(shù)據(jù)。本系統(tǒng)中使用SPI總線輸出數(shù)據(jù)，其比使用I2C總線傳輸速率快且控制更為簡單。但需要注意的是，當采用SPI總線輸出數(shù)據(jù)時，需要使用2個SPI總線的片選和輸出數(shù)據(jù)端口。這是由于模塊內(nèi)各傳感器的ODR是不同的，其本身就采用2個SPI端口分別輸出數(shù)據(jù)。其中一個端口輸出線性加速度和角速度數(shù)據(jù)，另一端口輸出磁場強度數(shù)據(jù)。

北斗接收機和iNEMO慣性傳感器模塊都是SoC芯片，集成度高、功耗低，周邊只需安裝若干貼片電感、電阻、電容和二極管，非常適用于對尺寸、功耗要求高的嵌入式測試系統(tǒng)。

2.2 主/從處理器

主/從處理器分別選用了ST公司基于ARM內(nèi)核的32位微控制器STM32F405(記為ARM1)、STM32F103(記為ARM2)。這兩款芯片都具有較好的處理速度和能效比，內(nèi)部集成了大容量的Flash和SRAM存儲器，擁有豐富的應用接口，中斷、時鐘控制靈活，抗干擾能力好，適用于嵌入式系統(tǒng)設計。STM32F405作為主處理器，可進行快速中斷處理，有較強的多任務管理能力，能夠滿足系統(tǒng)的高實時性要求。本系統(tǒng)中，ARM1的2個SPI接口、ARM2的UART接口分別與iNEMO慣性模塊、北斗接收機相連并接收數(shù)據(jù)。2個芯片都具有可變靜態(tài)存儲控制器(FSMC)，能夠匹配不同類型外部存儲器的存儲和讀取速率，產(chǎn)生相應的數(shù)據(jù)/地址/控制信號，與FPGA互聯(lián)可方便地完成大容量數(shù)據(jù)的高速傳輸。

2.3 FPGA邏輯電路設計

FPGA選擇的是Xilinx公司芯片XC6SLX75。FPGA邏輯電路如圖2所示。

圖2 FPGA邏輯電路框圖

接收到啟動電平指令后，32位的高精度計數(shù)器開始循環(huán)計數(shù)。當ARM2判斷北斗接收機的輸出有效時，即置TEN端口為低電平，以接收北斗1PPS脈沖信號。計數(shù)器檢測到1PPS脈沖信號的上升沿時，該計數(shù)器即刻被清零，清零后重新計數(shù)。有源晶振的時鐘輸入(OSC_CLK)為8 MHz。當1PPS秒脈沖信號無效時，計數(shù)器也可持續(xù)工作536 s。同時，為了保持系統(tǒng)的同步，會將計數(shù)器的時標信息作為ARM1讀數(shù)的標志。若設定iNEMO慣性模塊加速度計/陀螺儀、磁強計的采樣速率分別為100 Hz、10 Hz，計數(shù)器每隔80 000個、800 000個時鐘脈沖，會分別將此時刻的32位計數(shù)值(時標信息1、2)存入SRAM中，同時通過單脈沖發(fā)生器產(chǎn)生上升沿信號觸發(fā)ARM1的外部中斷端口EXTI1、EXTI2，驅(qū)動ARM1分別讀取加速度/角速度、磁場強度。

3 系統(tǒng)中數(shù)據(jù)的讀、寫設計

3.1 ARM程序設計

ARM2主要負責從北斗接收機UART接口輸出的NEMA0813格式的數(shù)據(jù)串中提取解算處理所需的信息，并將其存入FPGA的雙口RAM中。UART接口的傳輸速率較慢，而NNMEA-0183協(xié)議定義的輸出語句卻非常多。UM220-III模塊的輸出在該協(xié)議的基礎上進行了拓展，ARM2需要從 GGA、GSA、GSV、RMC、VTG、GLL、NAVPOS、NAVVEL、NAVTIME等類型的語句中提取導航解算所需的UTC時間、位置、速度、定位狀態(tài)等信息。若接收機定位無效，將TEN端口置高電平，屏蔽1PPS秒脈沖信號輸出；若接收機定位有效，則將TEN端口置低電平，使能1PPS秒脈沖信號，并通過FSMC總線將提取出的信息寫入到FPGA雙口RAM的單元3中，同時產(chǎn)生一個低電平脈沖觸發(fā)ARM1讀取北斗信息的中斷響應。ARM2通過串口提取北斗信息并存入FPGA內(nèi)。ARM2提取北斗信息子程序流程圖如圖3所示。

圖3 ARM2提取北斗信息子程序流程圖

ARM1是系統(tǒng)的主處理器。程序設計的關鍵是管理FPGA產(chǎn)生的外部中斷，并完成對應數(shù)據(jù)的讀取和存儲操作。FPGA會產(chǎn)生3類電平指示信號，其上升沿觸發(fā)ARM1的中斷寄存器，分別對應ARM1的EXTI1、EXTI2和EXTI3引腳。ARM1響應外部中斷子程序流程圖如圖4所示。

圖4 ARM1響應外部中斷子程序流程圖

3個外部中斷優(yōu)先級相同。當一個中斷到來后，如果正在處理另一個中斷，這個后到來的中斷就要等到前一個中斷處理完之后才能被處理，以防止數(shù)據(jù)存儲出現(xiàn)混亂。其中，EXTI1中斷驅(qū)動ARM1讀取慣性模塊的線性加速度/角速度及FPGA存儲的時間標志信息1，EXTI2中斷驅(qū)動ARM1讀取慣性模塊的磁場強度及FPGA存儲的時間標志信息2，EXTI3中斷驅(qū)動ARM1讀取FPGA存儲的北斗提取信息。ARM1讀取FPGA雙口RAM的數(shù)據(jù)時使用FSMC總線，讀取iNEMO慣性模塊數(shù)據(jù)時分別使用了2個SPI總線端口。ARM1讀出的數(shù)據(jù)都暫存入內(nèi)部RAM中，每次讀取時標信息2后都要進行判斷。該值若為0或為系統(tǒng)時鐘頻率的整數(shù)倍，即將所有數(shù)據(jù)頁寫入NAND Flash中(1次/s)。

3.2 數(shù)據(jù)存儲格式

每次頁寫入Flash中的數(shù)據(jù)包含一組北斗提取信息、若干組加速度/角速度信息、若干磁場強度信息，以及校驗碼和頭尾指示。其中，北斗提取信息包括定位狀態(tài)、UTC時間、北斗位置、北斗速度，加速度/角速度信息和磁場強度信息均包含對應的時標信息。Flash數(shù)據(jù)存儲基本格式如圖5所示。

圖5 數(shù)據(jù)存儲基本格式示意圖

4 試驗測試及結(jié)果分析

4.1 北斗1PPS信號偏差分析

本模塊中1PPS秒脈沖信號的偏差將直接影響后續(xù)濾波的精度。使用示波器同步觸發(fā)功能，對兩個模塊輸出的1PPS上升沿信號的時間差進行了測試。以其中一個模塊的輸出為基準，采集了70組連續(xù)的數(shù)據(jù)，得到了如圖6所示的試驗結(jié)果。

圖6 1PPS信號對比試驗結(jié)果

經(jīng)測試，2個功能模塊之間上升沿信號的偏差控制在±100 ns的范圍內(nèi)，均方根誤差為31.8 ns，而系統(tǒng)數(shù)據(jù)的最大采樣頻率為100 Hz。該北斗接收機輸出的秒脈沖完全達到性能指標，符合系統(tǒng)的使用要求。

4.2 iNEMO慣性模塊數(shù)據(jù)分析

本文采集了系統(tǒng)中的iNEMO慣性模塊傳感器的原始測量參數(shù)，設定加速度計/陀螺儀、磁強計的采樣頻率分別為100 Hz、10 Hz，將系統(tǒng)依次沿X-Y-Z軸進行順時針旋轉(zhuǎn)。數(shù)據(jù)處理終端根據(jù)數(shù)據(jù)的頭尾指示分離出各秒的數(shù)據(jù)，將各秒數(shù)據(jù)進一步分離為帶時間標記的三軸加速度、三軸陀螺傳感器、三軸磁傳感器數(shù)據(jù)。在初始瞄準狀態(tài)下，載體初始姿態(tài)在0附近跳變。在后續(xù)的數(shù)據(jù)處理中，利用iNEMO慣性模塊傳感器的輸出，并結(jié)合北斗導航數(shù)據(jù)，通過Kalman濾波器等方法，可以進一步實現(xiàn)初始對準和航姿解算的功能，得到精度較高的載體位置、速度、姿態(tài)(方位角、俯仰角、橫滾角)等信息[15-17]。

5 結(jié)束語

本系統(tǒng)以雙CPU+FPGA+Flash的數(shù)字硬件電路為核心，完成多通道導航數(shù)據(jù)的連續(xù)檢測和實時存儲。系統(tǒng)有機結(jié)合了衛(wèi)星和慣性兩種導航技術，可進行全天候、實時測姿，誤差不隨時間累積。當北斗接收機的信號受到干擾時，iNEMO慣性模塊在短時間內(nèi)的工作也不受影響，具有很強的魯棒性。該方法方便快捷、功耗小、成本低，設備可重復使用，不僅適用于各類彈載飛行試驗，也可應用于異構(gòu)多無人機等需要精確時間同步的領域。

[1] 黃成功,吳軍輝,陳前榮,等.紅外/毫米波復合末端制導彈藥作戰(zhàn)效能仿真評估[J].紅外與激光工程,2013,42(10)：2702-2706.[2] WANG W,ZHANG Z J.The intelligent storage recording system based on cluster bombs testing and the data analysis[J].Open Electrical and Electronic Engineering Journal,2015,9(1):530-533.

[3] 李杰,馬幸,劉俊,等.小型慣導系統(tǒng)數(shù)據(jù)實時采集處理與存儲設計[J].中國慣性技術學報,2008,16(3):274-277.

[4] 王巍.慣性技術研究現(xiàn)狀及發(fā)展趨勢[J].自動化學報,2013,39(6):723-729.

[5] 楊宗霖,姚速瑞,張浩峰.衛(wèi)星/慣性組合定位系統(tǒng)中的數(shù)據(jù)采集單元設計[J].電子器件,2015,38(2):452-457.

[6] 吳甜甜,張云,劉永明,等.北斗/GPS組合定位方法[J].遙感學報,2014,18(5):1087-1097.

[7] 楊元喜,李金龍,王愛兵,等.北斗區(qū)域衛(wèi)星導航系統(tǒng)基本導航定位性能初步評估[J].中國科學:地球科學,2014,44(1):72-81.

[8] 敖翔,崔曉偉,呂鵬,等.GNSS 姿態(tài)測量接收機性能分析[J].傳感器與微系統(tǒng),2015,34(2):65-68,72.

[9] 周曉,鄭定超,方玖琳.基于UM220的北斗接收機及WEB終端設計[J].計算機測量與控制,2016,24(3):238-240.

[10]李偉,孫書鷹,劉江義,等.基于LSM9DS0的姿態(tài)測量系統(tǒng)設計[J].計算機測量與控制,2014,22(9):2726-2729.

[11]朱文杰,王廣龍,高鳳岐,等.MIMU和磁強計組合在線定姿算法研究[J].自動化儀表,2013,34(11):21-25.

[12]李世光,王文文,申夢茜,等.基于STM32的姿態(tài)測量系統(tǒng)設計[J].現(xiàn)代電子技術,2016,39(9):12-14,16.

[13]曾桓濤,余志,張輝,等.GPS/INS組合導航數(shù)據(jù)同步時標的計算方法研究[J].傳感技術學報,2012,25(4):515-518.

[14]李倩,戰(zhàn)興群,王立端,等.GPS/INS 組合導航系統(tǒng)時間同步系統(tǒng)設計[J].傳感技術學報,2009,22((12):1752-1756.

[15]笪良龍,王文龍,孫芹東,等.一種微型矢量水聽器姿態(tài)測量系統(tǒng)[J].中國慣性技術學報,2016,24(1):20-25.

[16]GEORGY J,NOURELDIN A,KORENBERG M J,et al.Modeling the stochastic drift of a MEMS-based gyroscope in gyro/odometer/GPS integrated navigation[J].Intelligent Transportation Systems,2010,11(4):856-872.

[17]祝燕華,蔡體菁,楊卓鵬.MEMS-IMU/GPS 組合導航系統(tǒng)的實現(xiàn)[J].中國慣性技術學報,2009,17(5)：552-556,561.

Design of the Attitude and Heading Measurement System Based on Beidou/iNEMO

CHEN Kai1，WANG Guanglong2，WANG Cheng2

(1.66008 Unit of PLA,Tianjin 300250,China; 2.Laboratory of Nanotechnology and Microsystems,Mechanical Engineering College，Shijiazhuang 050003,China)

Based on Beidou receiver and iNEMO inertial sensor module,the sensing information acquisition micro system is designed for solving the carrier motion attitude azimuth.Due to the differences of the output data format,rate and interface for the two navigation units,the hardware architecture of double CPU+FPGA+Flash is adopted;by collaborative operation of two processors,the real time acquisition,storage,and storage of the large volume of multichannel navigation parameters is completed.The output IPPS pulse of Beidou is used as the zeroing signal,and considering that iMEMO has no fixed time reference system,the Beidou time scale information is added for iNEMO data,so the synchronization for data of sub units at the moment of each second sharp is implemented by the hardware logic circuit.The test results verify that the synchronization deviation of Beidou 1PPS second pulse signal will not affect the accuracy of subsequent filtering,and the module can stably output data with time stamp for the 3D accelerometer,3D gyroscope and 3D magnetometer,and the information of carrier,such as the position,velocity and attitude,etc.,can be obtained by the solution.The system has many advantages,such as small size,low power consumption,good robustness and reusing of the equipment.It is not only qualified to the test requirements of the single aerodynamic weapon,but also further improves the space-time testing precision of multiple targets navigation,by combining with the multi-sensor information fusion technology.

Beidou navigation system; Embedded system; Sensor; Unmanned plane; Remote sensing technology; FPGA; Time synchronization

國家自然科學青年基金資助項目(61501493)

陳凱(1983—)，男，碩士，工程師，主要從事測試計量技術及儀器的研究。E-mail：chenkai094@sina.com。

TH-39;TP274+.2

A

10.16086/j.cnki.issn1000-0380.201705013

修改稿收到日期：2016-12-15