GPS信號中斷時(shí)慣導芯片的位置信息感知系統設計
2 系統工作原理及主要控制信號說(shuō)明
本文研究了如何在移動(dòng)端GPS信息缺失的情況下,使用SPI協(xié)議建立FPGA與慣導芯片ADIS16003之間的通信,從而獲取移動(dòng)物體當前的加速度。DSP將通過(guò)EMIF接口讀取此加速度,并根據之前有效的GPS信息推算出當前的概略GPS信息(經(jīng)緯度、速度和時(shí)間等)。
2.1 工作原理
FPGA驅動(dòng)ADIS16003慣導芯片工作包括初始啟動(dòng)和正常啟動(dòng)兩種模式。
(1)初始啟動(dòng)模式
FPGA上電復位時(shí)自啟動(dòng)ADIS16003芯片,配置ADIS16003控制寄存器,并讀取芯片測得的雙軸軸向加速度初始值,存儲到EMIF接口的0x068~0x069地址空間供DSP讀取,用作誤差校正之用(此模式工作在移動(dòng)端處于靜止狀態(tài)時(shí),且此模式僅由DSP讀取1次)。
(2)正常啟動(dòng)模式
初始啟動(dòng)模式完成之后,FPGA將自動(dòng)轉入數據采集階段,源源不斷地通過(guò)SPI接口從ADIS16003芯片中采集雙軸軸向瞬時(shí)加速度,以備DSP使用。加速度每秒采集8次,每隔0.125 s采集一次。每秒都將得到8組結果,分別為ax0ay0、ax1ay1、ay2ay2、ax3ay3、ax4ay4、ax5ay5、ax6ay6和ax7ay7,存儲于FGPA內部的8個(gè)中間寄存器單元reg0~reg7(非EMIF接口,每個(gè)輸出結果為12×2位,存儲于32位的寄存器組中),并隨著(zhù)時(shí)間的推移不斷地刷新。這么做的目的是確保這8個(gè)寄存器組中始終保存有最近1 s的移動(dòng)物體加速度信息,以保證加速度信息的準確性和有效性。當CPU通過(guò)GPS接收天線(xiàn)檢測到GPS信息丟失時(shí),CPU通過(guò)PCI接口給FPGA配入spi_cmd_val信號(高電平有效),同時(shí)通過(guò)HPI接口給
DSP寫(xiě)入信息丟失前2 s的GPS信息(包括經(jīng)緯度、速度和時(shí)間),作為定位基點(diǎn)。FPGA檢測到spi_cmd_val信號有效后,立即將中間寄存器單元reg0~reg7中存儲的瞬時(shí)加速度送入EMIF接口的0x060~0x067地址單元(32位),同時(shí)拉高int_spi_done信號,產(chǎn)生外部中斷(拉低DSP的引腳)通知DSP從EMIF接口讀取加速度信息,并通過(guò)后續軟件算法進(jìn)行信號處理,轉化為移動(dòng)端經(jīng)緯度信息。再通過(guò)DSP的HPI接口上報給CPU,從而使高層獲取移動(dòng)端當前GPS信息,即完成了GPS位置信息的模擬。加速度存儲格式如表1所列。其中包括初始和瞬時(shí)加速度值,共占用32位EMIF接口10個(gè)地址單元。本文引用地址:http://dyxdggzs.com/article/150076.htm
2.2 主要控制信號說(shuō)明
①spi_cmd_data:ADIS16003芯片控制字(寄存器),8位,FPGA配入。
②spi_cmd_val:GPS信號缺失時(shí)ADIS16003啟動(dòng)信號,CPU發(fā)出,脈沖觸發(fā)。
③spi_cmd_val_reg:ADIS16003啟動(dòng)信號寄存器,及時(shí)存儲觸發(fā)脈沖,持續一個(gè)時(shí)鐘后清0。
④spi_data_i:ADIS16003串行輸出信號,包括雙軸軸向加速度,每個(gè)spi_clk時(shí)鐘下降沿輸出一位,16個(gè)時(shí)鐘周期完成一次運算。
⑤spi_cs:SPI片選信號,低電平有效。
⑥spi_clk:SPI通信時(shí)鐘信號,由主時(shí)鐘分頻得到,此處進(jìn)行32分頻。
⑦spi_data_o:ADIS16003控制字輸入信號,8位串行輸出,spi_clk時(shí)鐘上升沿動(dòng)作。
⑧spi_rdata:ADIS16003運算結果,12位,每個(gè)spi_clk下降沿輸出一位,采取移位拼接方式(向左移),在第16個(gè)時(shí)鐘下降沿輸出一次完整的采集結果(每次采集至少需要16個(gè)時(shí)鐘周期)。
⑨spi_state:SPI工作狀態(tài)信號,0為IDLE,1為BUSY,2為DONE,采用有限狀態(tài)機進(jìn)行設計。
⑩spi_wr_cnt_o、spi_wr_cnt_i:十六進(jìn)制計數器,時(shí)鐘上升沿和下降沿分別計數。
評論