Gravity-Based Methods for Heading Computation in Pedestrian Dead Reckoning
Abstract
:1. Introduction
- Calculation of the horizontal turning rate, which is equivalent to the vertical projection of the three-axis gyroscope measurements, can be used for computing the heading angle.
- Extracting the horizontal acceleration signal out of the three-axis accelerometer measurements can be employed for identifying the dominant horizontal motion direction (that is usually associated with the forward direction).
- Several step detection and step length estimation methods require only the vertical acceleration signal.
- In order to use magnetic sensors for solving the heading angle, information on the horizontal plane as embedded in the gravity direction needs to be incorporated as well.
1.1. Related Work
1.2. Paper Contributions
2. Methods for Gravity Direction Estimation
2.1. Problem Formulation
2.2. Accelerometer-Based Method
2.3. Gyroscope-Accelerometer Fusion Method
- The average angular rate in each of the gyro’s axes can be treated as the residual bias error because one can expect these measurements to be zero when the sensor is at rest. This estimated bias can be removed from any future gyro’s measurements, thus reducing possible drifts when integrating them.
- Determining the gravity direction based on the accelerometer alone is more reliable when the sensor is stationary, since no motion accelerations are present (though bias and other sensor errors still degrade the accuracy). In this case, we suggest averaging the measurements within the stationary interval instead of applying the low-pass filter, thus obtaining a single gravity direction estimation, , that will be used as initialization for the procedure described next.
- The attitude state of the sensor frame, relative to some reference frame, is represented by a quaternion, q. The estimation error quaternion, denoted , describes the residual rotation from the estimated sensor frame to the true one, which can be formalized as
- The process model of the filter is driven by the angular rate measurements of the gyro, as in (10). The linearized formulation of the attitude error dynamics is
- The measurement model of the filter uses direction vectors that are measured continuously in the sensor frame, with prior information about their static representation in the reference frame. For a single direction vector, y, with additive measurement error vector, v, the model is
- Initialization: Given an initial stationary time interval, , we first compute the average specific force vector, , by averaging the accelerometer measurements (axis-wise) in that interval. Then, using (7) with replacing , the reference gravity direction in the stationary sensor frame, , can be computed. In addition, the attitude quaternion state and the error covariance matrix need to be initialized. At , the instantaneous sensor frame is identical to the stationary one, thus the initial state estimate is the identity quaternion,
- Propagation step: The discretization of (10) with time step , under the approximation of constant during each time step, is as follows:
- Measurement update step: When a measured gravity direction, , is given at some time instance along with its covariance matrix, R, we first compute the measurement prediction using the prior estimate of the attitude quaternion, :
3. Methods for Heading Computation
3.1. Preliminary Remark on Heading Definition
3.2. Vertical Angular Rate Component
3.3. Signed-Magnitude Angular Rate
- The magnitude of vectors, when ignoring measurement errors, is independent of the frame in which they are measured, hence does not depend on the sensor’s orientation. In practice, however, systematic errors such as bias will cause the measured to have some dependence on the orientation.
- Although the turning rate of interest is disturbed by other angular rates, due to pedestrian’s motion, appropriate pre-filtering of is expected to eliminate most of them, so that the magnitude of the filtered measurements should approximate the true horizontal turning rate.
3.4. Dynamic Turn Rate Bias Compensation
- Initialize and .
- At time step , given the measured ,
- (a)
- Update the bias estimation by
- (b)
- Update the state indicator by thresholding with [deg/s],
- The corrected turning rate at time is calculated simply as
3.5. Magnetometer-Based Heading Computation
4. Experimental Results and Analysis
4.1. Ground Truth Heading
- Conducting the experiments in natural outdoor environment with open sky-view, which allows GNSS measurements with satisfactory accuracy.
- Designing the walking path as a sequence of straight segments connected by short curves; this imitates a typical indoor environment made of straight corridors.
- In addition, based on such walking paths, we can obtain relatively accurate ground truth, by averaging the GNSS-based heading data during each straight segment.
4.2. Gravity Direction Results
4.3. Heading Angle Results
4.4. Sequential Processing of Tri-Axis Sensors
- the calculation of gravity direction based on the accelerometer, as was described in Section 2.2, which involves the normalizing operation along with low-pass filtering;
- applying the magnitude calculation and LPF processing for the accelerometer (e.g., for step detection) or for the magnetometer (e.g, for magnetic fingerprint-based indoor navigation);
- projecting the gyroscope measurements onto the vertical direction, as in Equation (33), which requires low-pass filtering as well.
5. Conclusions
- When implementing gyroscope-based approaches, one must incorporate additional information or assumptions in order to mitigate its natural drifting. The method we proposed in this context makes use of straight path segments in order to dynamically adapt the estimated bias of the horizontal turning rate. This relatively simple model appears to produce reasonable heading accuracy throughout the entire experiment.
- Using magnetic sensor for heading computation can be implemented by directly employing the gravity unit vector, as suggested in Section 3.5. This method showed superior performance compared to the gyroscope-based methods in the tested outdoor scenario, though it might be subject to more significant magnetic disturbances when applied indoors.
- Considering the vertical projection of the gyroscope versus the magnitude of the angular rate vector, it seems that the former is more accurate as a means for computing the heading angle. Moreover, it naturally allows for distinguishing between left and right turns.
Author Contributions
Funding
Conflicts of Interest
Abbreviations
PDR | Pedestrian Dead Reckoning |
NED | North–East–Down |
LPF | Low-Pass Filter / Filtering |
GNSS | Global Navigation Satellite System |
WMM | World Magnetic Model |
References
- Beauregard, S.; Haas, H. Pedestrian dead reckoning: A basis for personal positioning. In Proceedings of the 3rd Workshop on Positioning, Navigation and Communication, Hannover, Germany, 16 March 2006. [Google Scholar]
- Elhoushi, M.; Georgy, J.; Noureldin, A.; Korenberg, M.J. A survey on approaches of motion mode recognition using sensors. IEEE Trans. Intell. Transp. Syst. 2017, 18, 1662–1686. [Google Scholar] [CrossRef]
- Klein, I.; Solaz, Y.; Ohayon, G. Pedestrian Dead Reckoning With Smartphone Mode Recognition. IEEE Sens. J. 2018, 18, 7577–7584. [Google Scholar] [CrossRef]
- Manos, A.; Klein, I.; Hazan, T. Gravity Direction Estimation and Heading Determination for Pedestrian Navigation. In Proceedings of the 2018 International Conference on Indoor Positioning and Indoor Navigation (IPIN), Nantes, France, 24–27 September 2018. [Google Scholar]
- Harle, R. A survey of indoor inertial positioning systems for pedestrians. IEEE Commun. Surv. Tutor. 2013, 15, 1281–1293. [Google Scholar] [CrossRef]
- Subbu, K.; Zhang, C.; Luo, J.; Vasilakos, A. Analysis and status quo of smartphone-based indoor localization systems. IEEE Wirel. Commun. 2014, 21, 106–112. [Google Scholar] [CrossRef]
- Kang, W.; Han, Y. SmartPDR: Smartphone-based pedestrian dead reckoning for indoor localization. IEEE Sens. J. 2015, 15, 2906–2916. [Google Scholar] [CrossRef]
- Deng, Z.-A.; Wang, G.; Hu, Y.; Wu, D. Heading estimation for indoor pedestrian navigation using a smartphone in the pocket. Sensors 2015, 15, 21518–21536. [Google Scholar] [CrossRef] [PubMed]
- Nguyen, P.; Akiyama, T.; Ohashi, H.; Nakahara, G.; Yamasaki, K.; Hikaru, S. User-friendly heading estimation for arbitrary smartphone orientations. In Proceedings of the 2016 International Conference on Indoor Positioning and Indoor Navigation (IPIN), Madrid, Spain, 4–7 October 2016; pp. 1–7. [Google Scholar]
- Michel, T.; Genevès, P.; Fourati, H.; Layaïda, N. Attitude estimation for indoor navigation and augmented reality with smartphones. Pervasive Mob. Comput. 2018, 46, 96–121. [Google Scholar] [CrossRef] [Green Version]
- Groves, P.D. Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems; Artech House: Norwood, MA, USA, 2013. [Google Scholar]
- Porat, B. A Course in Digital Signal Processing; John Wiley & Sons, Inc.: New York, NY, USA, 1996. [Google Scholar]
- Brajdic, A.; Harle, R. Walk detection and step counting on unconstrained smartphones. In Proceedings of the 2013 ACM international Joint Conference on Pervasive and Ubiquitous Computing, Zurich, Switzerland, 8–12 September 2013; pp. 225–234. [Google Scholar]
- Markley, F.L.; Crassidis, J.L. Fundamentals of Spacecraft Attitude Determination and Control; Springer: New York, NY, USA, 2014; Volume 33. [Google Scholar]
- Maus, S.; Macmillan, S.; McLean, S.; Hamilton, B.; Thomson, A.; Nair, M.; Rollins, C. The US/UK World Magnetic Model for 2010–2015; British Geological Survey: Keyworth, UK, 2010. [Google Scholar]
- Salycheva, A.O.; Cannon, M.E. Kinematic azimuth alignment of INS using GPS velocity information. In Proceedings of the NTM 2004 Conference (Session E3), San Diego, CA, USA, 26–28 January 2004. [Google Scholar]
Method Title | Section | |
---|---|---|
Gravity Direction Estimation | Accelerometer-based | Section 2.2 |
Fusion-based | Section 2.3 | |
Heading Computation | -based | Section 3.2 |
-based | Section 3.3 | |
Modified -based | Section 3.4 | |
Magnetic-based | Section 3.5 |
Gravity Direction Method | |||
---|---|---|---|
Accelerometer-Based | Fusion-Based | ||
Heading Method | -Based | N.C. | N.C. |
-Based | N.C. | N.C. | |
Modified -Based | <15 [deg] | 9 [deg] | |
Magnetic-Based | ≈6 [deg] | fluctuating |
© 2019 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).
Share and Cite
Manos, A.; Klein, I.; Hazan, T. Gravity-Based Methods for Heading Computation in Pedestrian Dead Reckoning. Sensors 2019, 19, 1170. https://doi.org/10.3390/s19051170
Manos A, Klein I, Hazan T. Gravity-Based Methods for Heading Computation in Pedestrian Dead Reckoning. Sensors. 2019; 19(5):1170. https://doi.org/10.3390/s19051170
Chicago/Turabian StyleManos, Adi, Itzik Klein, and Tamir Hazan. 2019. "Gravity-Based Methods for Heading Computation in Pedestrian Dead Reckoning" Sensors 19, no. 5: 1170. https://doi.org/10.3390/s19051170
APA StyleManos, A., Klein, I., & Hazan, T. (2019). Gravity-Based Methods for Heading Computation in Pedestrian Dead Reckoning. Sensors, 19(5), 1170. https://doi.org/10.3390/s19051170