A Particle Filter Method for Pedestrian Navigation Using Foot-mounted Inertial Sensors
-
摘要: 為了解決衛(wèi)星導(dǎo)航信號被遮擋條件下定位問題,該文提出一種基于慣性鞋載傳感器的高精度人員自主定位方法。該方法通過經(jīng)典的拓展卡爾曼濾波輔助的零速更新(ZUPT-aided EKF)算法解算鞋尖慣性測量數(shù)據(jù)得到人員的初步運(yùn)動軌跡,并創(chuàng)新性地提出一種粒子濾波框架下利用建筑物結(jié)構(gòu)先驗知識對軌跡進(jìn)行修正的方法。根據(jù)大多數(shù)建筑物的結(jié)構(gòu),將行走平面劃分為8個方向,包含4個主方向(走廊朝向)和4個輔助方向。根據(jù)粒子偏離8方向的程度按照高斯函數(shù)對粒子的權(quán)值進(jìn)行更新,并用剩余重采樣的方法避免了粒子的退化。實測數(shù)據(jù)驗證了該文提出的方法,結(jié)果表明:該方法比軌跡修正前和傳統(tǒng)軌跡修正的方法有更好的精度,在861 m的復(fù)雜軌跡下定位誤差僅為2.7 m,定位精度優(yōu)于0.5%;同時該方法有較好的一致性,不同樓層間的行走定位誤差保持在2 m內(nèi), 可以進(jìn)行穩(wěn)定持續(xù)地定位。Abstract: During GPS outages, the foot-mounted inertial-based sensors are common replacement in pedestrian navigation. The Zero velocity UPdaTe-aided Extended Kalman Filter (ZUPT-aided EKF) is often used to resolve the trajectory of a walking pedestrian with acceleration and angular rate measurements from foot-mounted sensors. However, the trajectory suffers from long-term drifts, which needs to be calibrated. This paper proposes a particle filter based approach for trajectory calibration, which exploits apriori knowledge of building structures to update particle weight. The buildings are supposed to have four domain directions, which is defined by the layout of corridors. The navigation frame is divided by eight directions, including four domain directions and four complementary directions, and the weight is assigned according to the eight directions using a Gaussian function. Finally, several real-scenario experiments are carried out, which can demonstrate that the proposed approach have better accuracy and consistency than the results without calibration or traditional methods, as the proposed approach can reach a location error of 2.7 m in a complex-trajectory walk of 861 m and the accuracy is better than 0.5%; the fact that the location error remains below 2 m in different floors also demonstrates the good consistency of the approach. As a result, the proposed approach can perform stable and continuous positioning.
-
計量
- 文章訪問數(shù): 1697
- HTML全文瀏覽量: 137
- PDF下載量: 504
- 被引次數(shù): 0