特徵提取型同時定位與建圖演算法及其在FPGA之實現

FPGA-Based Realization for Feature Extracting Simultaneous Localization and Mapping

石顏彰(Yan-Jhang Shih) ； 簡宜興(Yi-Hsing Chien) ； 許陳鑑(Chen-Chien Hsu) ； 王偉彥(Wei-Yen Wang)

《健行學報》 36卷3期 (2016/07) Pp. 55-73

摘要

FastSLAM 為解決同時定位與建圖的有效方法，但由於地標數過多，容易造成運算量過於龐大而導致系統發散。原始的快速同時定位及建圖收斂效果好，但會因為地標數目增加所造成誤差的累積，而導致系統發散，本論文透過向量比對機制，使得特徵變化較大的感測資訊被保留下來，減少與現有地標比對的機會，且使得資料關聯的結果較為準確，最後更利用準確的地標更新機器人的位置以提升定位精準度。為了驗證本論文所提出方法可以有效提升精確度以及降低運算量，我們將利用傳統FastSLAM 與本論文所提出之特徵提取型SLAM以不同地圖進行模擬並比較其結果。此外，本論文也使用FPGA 晶片將此改良型同時定位及建圖方法實現於硬體電路以縮短運算時間，並增加其演算法之運用性。

關鍵字

同時定位及建圖 ； 粒子濾波器 ； 卡爾曼濾波器 ； 特徵提取 ； 場效可程式邏輯閘陣列

並列摘要

FastSLAM is an effective method to solve simultaneous localization and mapping. However, when the number of landmarks increases, more comparisons of the current measurements with all the existing landmarks in particles will be compared and the accuracy of the estimated location of the robot and landmark decreases because of incorrect data association. In order to solve this problem, this paper presents an enhanced architecture for FastSLAM called Feature Extracting SLAM (FESLAM), where current measurement is filtered to extract special measurement to avoid getting unnecessary and wrong landmarks. To further refine the robot pose, we use triangulation and set on maximum likelihood mapping framework. Simulation results show the proposed approach has a better performance in terms of better localization and mapping than those obtained by the traditional SLAM algorithms. To further reduce the computation time, the improved SLAM algorithm is realized on FPGA circuit to verify the practicability of the proposed algorithm. Experimental results show the execution efficiency of FESLAM is significantly improved by the full hardware design for embedded applications.

並列關鍵字

Simultaneous Localization and Mapping (SLAM) ； Particle Filter ； Kalman Filter ； Feature Extracting ； FPGA