基于FPGA的慣導組合數(shù)據(jù)采集及控制系統(tǒng)設計
在系統(tǒng)設計中FPGA采用Xilinx公司的ISE軟件進行編程,FPGA主要完成IMU,GPS數(shù)據(jù)的接收處理,PWM控制等功能。在系統(tǒng)中IMU,GPS數(shù)據(jù)通過電平轉(zhuǎn)換電路連接至FPGA,F(xiàn)PGA通過不間斷地檢測IMU和GPS的數(shù)據(jù)頭信息進行接收并進行相應處理,IMU,GPS數(shù)據(jù)接收的RTL實現(xiàn)圖如圖3所示。本文引用地址:http://m.ptau.cn/article/190676.htm
在系統(tǒng)中,IMU數(shù)據(jù)以RS 422接口形式提供,信息速率為115 200 b/s,由幀頭、陀螺角速度信息、加速度信息、陀螺溫度信息、加速度溫度信息,時間信息和校驗和組成。在工作過程中,F(xiàn)PGA首先檢測是否接收到IMU數(shù)據(jù)的開始信息即幀頭,如果沒有接收到就一直進行檢測,如果收到就接收并進行相應的處理和存儲。接收完1幀IMU數(shù)據(jù)后,F(xiàn)PGA對這些信息進行累加校驗,并將計算得到校驗結果和接收到的數(shù)據(jù)校驗信息進行比較,如果校驗信息一致則存儲該幀信息,存儲地址自動加1,如不一致則丟掉該幀信息,存儲地址不變。信息接收完成后,產(chǎn)生接收完成標志位。
GPS數(shù)據(jù)由衛(wèi)星導航接收機以RS 232接口的形式提供,能實現(xiàn)機動載體的實時高精度三維定位、三維測速、精確定時。GPS數(shù)據(jù)的接收及處理原理和IMU數(shù)據(jù)類似,不同之處在于需要檢測信息頭和需存儲的數(shù)據(jù)長度不同。
IMU和GPS數(shù)據(jù)均采用乒乓存儲的方式進行存儲,乒乓存儲空間以幀為單位,最小空間為2幀,此時IMU和GPS數(shù)據(jù)在2幀的存儲空間中交替進行存儲。乒乓存儲空間的大小可以根據(jù)需要進行改變,存儲空間的改變由導航計算機通過串口進行設置,更改時無需重新編寫下載軟件。
PWM控制器根據(jù)需要由導航計算機控制,可以產(chǎn)生電機控制信號和任意占空比的PWM信號。為避免初始化不定狀態(tài)對輸出控制信號對電機的影響,由導航計算機對PWM控制器的輸出信號狀態(tài)進行控制。
3 仿真驗證
慣導數(shù)據(jù)采集與控制系統(tǒng)采用Xilinx公司的ISE軟件進行設計和驗證。IMU數(shù)據(jù)和GPS數(shù)據(jù)通過計算機模擬產(chǎn)生,PWM控制信號由導航計算機通過串口提供,仿真驗證結果如圖4所示。
在該系統(tǒng)中,F(xiàn)PGA接收到IMU和GPS數(shù)據(jù)后存儲在指定的存儲空間內(nèi),IMU數(shù)據(jù)接收完成并校驗通過后,產(chǎn)生接收完成標志0xAA55,GPS接收完成后產(chǎn)生0xAAAA標志,導航計算機通過讀取這些完成標志來獲取IMU和GPS數(shù)據(jù)。導航計算機讀取完成后產(chǎn)生復位標志,此時,IMU和GPS數(shù)據(jù)的接收標志均復位為0x0101,仿真驗證采用的IMU和GPS接收數(shù)據(jù)的乒乓存儲空間為2幀。PWM信號的占空比由導航計算控制,驗證采用的占空比分別為0,15%,50%,80%和100%。
4 結語
本文充分利用FPGA豐富的可編程資源,設計了基于FPGA的捷聯(lián)慣導數(shù)據(jù)采集和控制系統(tǒng),能夠同時采集1MU數(shù)據(jù)和GPS數(shù)據(jù),并能產(chǎn)生任意占空比的PWM控制信號。測試表明該系統(tǒng)能夠保證慣導系統(tǒng)的運算速度和精度,且具有較豐富的外設接口,方便與導航計算機和外部傳感器進行數(shù)據(jù)通信接口電路的設計,對慣導系統(tǒng)小型化及廣泛應用具有實際意義。
評論