Next Article in Journal
A New Deep Learning Model for Fault Diagnosis with Good Anti-Noise and Domain Adaptation Ability on Raw Vibration Signals
Next Article in Special Issue
PDMAA Hydrogel Coated U-Bend Humidity Sensor Suited for Mass-Production
Previous Article in Journal
A Temperature-Dependent Battery Model for Wireless Sensor Networks
Previous Article in Special Issue
A Sensor Data Fusion System Based on k-Nearest Neighbor Pattern Classification for Structural Health Monitoring Applications
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Dual MIMU Pedestrian Navigation by Inequality Constraint Kalman Filtering

1
School of Aeronautics and Astronautics, Central South University, Changsha 410083, China
2
Shanghai Key Laboratory of Navigation and Location based Services, School of Electronic Information and Electrical Engineering, Shanghai Jiao Tong University, Shanghai 200240, China
*
Author to whom correspondence should be addressed.
Sensors 2017, 17(2), 427; https://doi.org/10.3390/s17020427
Submission received: 30 November 2016 / Revised: 9 February 2017 / Accepted: 19 February 2017 / Published: 22 February 2017
(This article belongs to the Special Issue System-Integrated Intelligence and Intelligent Systems)

Abstract

:
The foot-mounted inertial navigation system is an important method of pedestrian navigation as it, in principle, does not rely any external assistance. A real-time range decomposition constraint method is proposed in this paper to combine the information of dual foot-mounted inertial navigation systems. It is well known that low-cost inertial pedestrian navigation aided with both ZUPT (zero velocity update) and the range decomposition constraint performs better than those in their own respective methods. This paper recommends that the separation distance between the position estimates of the two foot-mounted inertial navigation systems be restricted by an ellipsoidal constraint that relates to the maximum step length and the leg height. The performance of the proposed method is studied by utilizing experimental data, and the results indicate that the method can effectively correct the dual navigation systems’ position over the traditional spherical constraint.

1. Introduction

Positioning and tracking systems have developed over several decades in various applications, ranging from tracking of pedestrians to autonomous vehicles [1]. A high-precision navigation system is often needed for urban and indoor lives where GPS is unavailable, for example, in wearable body area networks [2]. Increasing attention for the pedestrian navigation problem can be partially attributed to the significant progress in affordable wearable computing platforms and enhancement in sensor quality, especially with respect to micro electro mechanical systems (MEMS) [3]. The micro inertial measurement units (MIMU) usually consist of gyroscopes, accelerometers, magnetometers, and pressure sensors [4].
In real-life application, however, the low-cost inertial navigation systems suffer from the accumulation of errors while calculating the traveled distance of the objects. These errors cause the trajectories to drift away from the actual path as time grows. An effective technique is to bind the error growth using ZUPT [5]. In [6], the authors presented an open-source, real-time, embedded implementation of a foot-mounted, zero-velocity-update-aided inertial navigation system (INS).
When we use the ZUPT-aided INS to track pedestrian location, the heading drift of navigation information is unobservable [7], so it is difficult to get accurate location information only through ZUPT in long-term navigation. Some previous works used the information fusion of multiple inertial sensors to ulteriorly correct the position [8,9]. As shown in [8], the use of the two-feet range constraints can significantly improve the navigation performance and a 110 m straight-line experiment showed that the spherical constraint algorithm can reduce the mean error and covariance of the final position estimates.
In [9], the authors proposed a method for a dual-mounted INS to reduce the systematic heading drift. They set up a dual MIMU system with two feet, in which the maximum distance between the two systems is derived from the calibration procedure. The proposed algorithm can obtain the walk trajectory when the initial heading estimates are known, but the method did not significantly improve the positioning accuracy of the system.
The experiments in [8,9] are two-dimensional (2-D) plane experiments, and the feasibility of the algorithm in three-dimensional space was not verified. When we use the spherical constraint [8] based on maximum step size to correct the position of the two feet, if the step size is greater than the height of heels, the spherical constraint algorithm would have little significant effect on the height constraint of the two feet. Therefore, in this paper we take into account different separation constraints in level and height directions, which is shown to be more effective to correct the pedestrian location.

2. Principle and Theory

2.1. Discrete Kalman Filter

The Kalman filter addresses the general problem of estimating the state X k of a discrete-time process that is governed by the linear stochastic difference equation [10,11]:
X k = Φ k , k 1 X k 1 + Γ k 1 W k 1
with a measurement Z k that is
Z k = H k X k + V k
where Φ k , k 1 denotes transition matrix relating the state at the previous time step t k 1 to the state at the current step t k , Γ k 1 denotes the system noise drive matrix, H k represents a measurement matrix, V k is series of measurement noise, and W k represents noise excitation sequence for the system. The W k and V k simultaneously meet:
E [ W k ] = 0 , Cov [ W k , W j ] = E [ W k W j T ] = Q k δ k j E [ V k ] = 0 , Cov [ V k , V j ] = E [ V k V j T ] = R k δ k j Cov [ W k , V j ] = E [ W k V j T ] = 0 .
In practice, the process noise covariance matrices Q k and measurement noise covariance matrices R k might change with each time step or measurement, and we assume they are a positive definite matrix:
X ^ k = X ^ k / k 1 + K k ( Z k H k X ^ k / k 1 )
K k = P k / k 1 H k T ( H k P k / k 1 H k T + R k ) 1
P k / k 1 = Φ k , k 1 P k 1 Φ k . k 1 T + Γ k 1 Q k 1 Γ k 1 T
P k = ( I K k H k ) P k / k 1
Equations (4)–(7) are the basic equations of Kalman filtering. If the initial values about X ^ 0 and P 0 are given, we can perform the state estimation at time k according to measurements Z k at the same moment.

2.2. Inequality Kalman Filter

The inequality Kalman filter appears in solving practical problems between state variables where there are inequality relationships [12]. The inequality relationship can be expressed as a constraint equation and combined with the Kalman filter, as a result of which the optimal solution strictly conforms to the inequality constraints between state variables, and a better result could be obtained.
The inequality-constrained Kalman optimal solution [13] is expressed as
min x ^ ( x ^ k x k ) T T ( x ^ k x k ) L x k d }
where x k is the unconstrained (standard) Kalman filter estimate and T is a symmetric positive definite weighting matrix [14,15]. As such, the weighted error of the constrained filter is minimized [16]. Expanding the first type of Equation (8):
( x ^ k x k ) T T ( x ^ k x k ) = x ^ k T T x ^ k 2 x k T T x ^ k + x k T T x k
Thus, the inequality constrained problem can be further simplified as
min x ^ ( x ^ k T T x ^ k 2 x k T T x ^ k ) L x k d }

3. Methods

3.1. Generalized Likelihood Ratio Test (GLRT)

The output of MIMU can be expressed as
x k = [ x k a x k ω ] T
where the specific force measurement vector x k a Ω 3 and the angular rate measurements vector x k ω Ω 3 . Assuming a series of measured value y n = { x k } k = n n + N 1 . We employ a double hypothesis testing as such, H 0 : MIMU stationary, H 1 : MIMU moving. The false alarm probability is expressed as
P F A = P { H 0 | H 1 } = α
The detection probability is P D = P { H 0 | H 0 } . Two hypotheses' observation data probability density functions are, respectively, defined as p ( y n ; H 0 ) and p ( y n ; H 1 ) .
The mathematical sensor model can be expressed as x k = s k ( θ ) + v k , where s k ( θ ) = [ s k a ( θ ) s k ω ( θ ) ] T and v k = [ v k a v k ω ] T , the force of MIMU is s k a ( θ ) Ω 3 , and MIMU angular rate is expressed as s k ω ( θ ) Ω 3 . The symbol θ denotes the vector of unknown elements v k a Ω 3 accelerometers noise, v k ω Ω 3 gyroscopes noise. Assume the noises follows zero mean Gaussian distribution, with noise covariance matrix Z = E { v k v k T } = [ σ a 2 I 3 × 3 0 3 × 3 0 3 × 3 σ ω 2 I 3 × 3 ] , where σ a 2 and σ ω 2 , respectively, represent accelerometers and gyroscopes noise variance.
Since the sensor measurement can be obtained from the joint probability density as
p ( y n ; θ , H i ) = k Ω n p ( x k a ; θ , H i ) p ( x k ω ; θ , H i )
where:
p ( x k a ; θ , H i ) = 1 ( 2 π σ a 2 ) 3 / 2 exp { 1 2 σ a 2 x k a s k a ( θ ) 2 }
p ( x k ω ; θ , H i ) = 1 ( 2 π σ ω 2 ) 3 / 2 exp { 1 2 σ ω 2 x k ω s k ω ( θ ) 2 }
GLRT is determined by the hypothesis H 0 if
L G ( y n ) = p ( y n ; θ ^ 0 , H 0 ) p ( y n ; θ ^ 1 , H 1 ) > λ
where λ denotes the threshold. In Equation (12), θ ^ 0 and θ ^ 1 represent the maximum likelihood estimate of the unknown element under the assumptions H 0 and H 1 , respectively. Equation (12) can be simplified as
L G ( y n ) = exp ( 1 2 σ a 2 k Ω n x k a g x ¯ k a x ¯ k a 2 1 2 σ ω 2 k Ω n x k ω 2 )
T ( y n ) = 2 N ln L G ( y n ) = 1 N k Ω n ( 1 σ a 2 x k a g x ¯ k a x ¯ k a 2 + 1 σ ω 2 x k ω 2 ) .
T ( y n ) < λ means that the pedestrian is in a stationary state.
In practice, ZUPT can effectively aid inertial navigation system to remove long-time accumulated errors [5,17]. The velocity error of carrier is used as a concept [18,19]. When pedestrians stay static, the MIMU measured velocity is regarded as an error to correct the system using Kalman filtering.
The state error vector is defined as
δ X = [ δ ϕ T δ ω T δ r T δ v T δ a T ] T
which, respectively, represents the three-dimensional attitude error, gyro drift, position error, velocity error and accelerometer bias.
The zero-velocity correction Kalman filter model is
{ δ X k = Φ k δ X k 1 + W k 1 δ Z k = H k δ X k + V k .
When the MIMU is stationary, the speed is zero, in theory; thus, the ZUPT speed measurement equation is
δ Z v , k = Δ v k b = v k b [ 0 0 0 ] T
where the state transition matrix is given as
Φ k = [ I 3 × 3 Δ t C b k | k - 1 n 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 Δ t I 3 × 3 0 3 × 3 Δ t S ( f k n ) 0 3 × 3 0 3 × 3 I 3 × 3 Δ t C b k | k - 1 n 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 ]
S ( f k n ) = [ 0 a z k n a y k n a z k n 0 a x k n a y k n a x k n 0 ]
where S ( f k n ) is the specific force anti-symmetric matrix, and H k = [ 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 ] .

3.2. The Ellipsoidal Constraint Method

Each foot are fixedly mounted by a MIMU. For regular human kinematics, the separation distance between the right and left feet cannot be larger than a quantity known as foot-to-foot maximum separation [8,9]. The maximum step size is a typical feature of pedestrian to walk and can be used to constrain the navigation error [20,21], namely, in addition to using ZUPT to improve the accuracy of pedestrian navigation. In specific, we decompose the constraint into three degrees of freedom and then use the obtained sub-constraints to correct the navigation system. Based on this intuition, we constrain the position estimate of right and left foot-mounted ZUPT-aided INSs.
According to the coordinate system identified of the MTI-G-700 units (3D motion tracking system, from Xsens Technologies B.V., Enschede, The Netherlands), the carrier coordinate system, as shown in Figure 1, shows the Xb axis is parallel to the surface of the MIMU, in the forward direction, and the Zb axis is perpendicular to the MIMU surface, in the upward direction. In this dual-MIMU integrated navigation system, the navigation coordinate system’s Xn axis is forward, the Yn axis points to the right, and the Zn axis perpendicular to the XnOYn plane, upwards. The coordinates of the navigation subsystem bound to the feet are defined in the same way.
For two MIMU navigation systems, the i = L , R , system real state is described as x k i (including position, velocity, and attitude), the estimated state as x ^ k i at the time k , where x k i n i , x ^ k i n i .
The joint state vector is defined as
{ x k = d e f [ ( x k L ) T ( x k R ) T ] T x ^ k = d e f [ ( x ^ k L ) T ( x ^ k R ) T ] T
where x ^ k m ( n 1 + n 2 = m ) .
Letting the maximum step size of the pedestrian be given by γ , the real displacement difference between the two navigation systems should be less than or equal to γ . As the leg height is subject to certain constraints, during the pedestrian normal walking state, the positions of the right and left foot can be approximately constrained in a ellipsoid (Figure 2). The position of one foot is constrained within the circle of radius γ in the XOY plane, and is confined within the circle with leg-related radius h in XOZ and YOZ planes, both centered at the other foot (Figure 3).
Assuming that left foot is on the ground and the right foot is in movement at moment k (Figure 3), then we can calculate α , defined as the angle between the position of the two feet in the XOY plane (in navigation coordinate system):
α = arctan | x k R x k L y k R y k L | .
As we can see from Figure 2, there is a space azimuth β between the right and the static left foot, we can calculate this angle by the positional relationship between the feet:
β = arctan | z k R z k L | ( y k R y k L ) 2 + ( x k R x k L ) 2
Therefore, the ellipsoidal constraint correction algorithm between the feet can be defined as
[ L s L h ] x k ( γ x γ y h z )
Defining the matricies,
L s = [ 1 0 0 0 1 0 0 2 × 6 1 0 0 0 1 0 0 2 × 6 ]
L h = [ 0 0 1 0 0 0 0 0 0 0 0 1 0 0 0 0 0 0 ]
where γ x represents the real-time constraint value of the ellipsoid constraint on the Xn axis, so γ x = γ sin α ; γ y represents the real-time constraint value of the ellipsoid constraint on the Yn axis, so γ y = γ cos α ; h z represents the real-time constraint value of the ellipsoid constraint on the Zn axis, so h z = h tan β .
We assume that two navigation systems attitude is accurate in the current moment when the decompose step size constraint. When L s x k 2 γ 2 + L h x k 2 h z 2 > 1 can constraint the state to be satisfied with { x m : L s x k 2 γ 2 + L h x k 2 h z 2 1 } the state modification is recommended as
{ p ( x ^ k ) = d e f arg x min ( x ^ k x ) T P k 1 ( x ^ k x ) L s x k 2 γ 2 + L h x k 2 h z 2 1
where P k 1 denotes the Kalman filter estimated covariance matrix state.
Defining L = [ 1 / γ x 0 0 0 1 / γ y 0 0 0 1 / h z 0 3 × 6 1 / γ x 0 0 0 1 / γ y 0 0 0 1 / h z 0 3 × 6 ] , Equation (22) can be written as
{ p ( x ^ k ) = d e f arg x min ( x ^ k x ) T P k 1 ( x ^ k x ) x k T L T L x k 1 .
The covariance matrix of the process measurement noise of the dual-MIMU integrated navigation system is
Q k = [ Q a 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 Q ω 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 Q a 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 Q ω ]
where Q a = [ σ a x 2 0 0 0 σ a y 2 0 0 0 σ a z 2 ] , Q ω = [ σ ω x 2 0 0 0 σ ω y 2 0 0 0 σ ω z 2 ] , σ a = [ 0.5 0.5 0.5 ] T , and σ ω = [ 0.5 0.5 0.5 ] T × π / 180 .
The covariance matrix of the measurement noise of the dual-MIMU integrated navigation system is
R k = [ σ v x 2 0 0 0 0 0 0 σ v y 2 0 0 0 0 0 0 σ v z 2 0 0 0 0 0 0 σ v x 2 0 0 0 0 0 0 σ v y 2 0 0 0 0 0 0 σ v z 2 ]
where σ v = [ 0.01 0.01 0.01 ] T .
The sampling rate of the filter is 400 Hz.

4. Experiment

To compare the performance of the proposed algorithm with the existing in [8] (the spherical constraint method). Experiments are carried out using two MTI-G-700 units and the performance parameters of them are shown in Table 1. The procedure is summarized as follows:
(1)
In a complex 2D environment: some closed trajectory containing a straight line path and turning eight times (turning angle: 90°).
(2)
In a complex 3D environment: a six-story staircase, and parts of corridors in the Sheng-Hua building at the Central South University. The walk strats at the first floor and ends at the sixth floor.
According to the experimenter gait characteristics, we set γ = 0 . 6 m and h = 0 . 3 m, respectively.
In the 2-D closed experiment, the ZUPT-aided INS can track the pedestrian feet positions (Figure 4), but the distance of two feet reaches about 6 m, which is unreasonable in pedestrian navigation. Comparing the three different sets of trajectories, the position estimation information under the ellipsoidal restriction can obtain the position estimates more accurately. Figure 5 shows the relative positions of the two feet in the z axis direction. Since h z constrains the altitude difference, the feet height difference can be reduced near to the true value and the pedestrian location can be more accurate.
For estimation evaluation, we have chosen the root mean square error (RMSE) as an accuracy measure in this work. This is used to measure the difference between the actual values and the output of an estimator. For quantitative comparison, we only checked the starting and final positions, both in 2D and 3D, in all walking tests. We assume the starting position of the left foot and right foot as (0, 0.1, 0) and (0, –0.1, 0), hence, only the final estimates are inserted into the RMSE formula. Both of these quality indicators are given in comparison Table 2. Note that the unconstrained method represented the results of only ZUPT corrections. Both spherical and ellipsoidal constraint methods can reduce the 2D and 3D trajectories error, but the latter obviously reduces the proportion more, and the correction effect is more obvious.
In the 3D upstairs experiment, the result shows the maximum step ellipsoidal constraint method reduces the error accumulation in the z -axis direction effectively. From the results presented in Figure 6 and Figure 7, we can observe that the proposed method in this paper can reduce the altitude difference of the feet position from 2.6 m to 0.56 m. Comparing to the spherical constraint method, the relative positions concentrate between –0.3 to 0.3 m which are obviously smaller than the spherical confinement results and are more suitable to the characteristics of the feet height on the stairs. By analyzing the results obtained in Figure 6 and Figure 7, we observe that the proposed algorithm can track the feet trajectory more accurately than the spherical constraint method.
In the indoor upstairs test, because of the objective factors of the irregular staircase, we are unable to accurately know the horizontal coordinate of the end point. However, the position in the Zn axis can be accurately measured, so, in this experiment, we only analyze the root mean square error in the Zn axis direction. The numerical results are given in Table 3.

5. Results

Low-cost inertial pedestrian navigation aided with both ZUPT and the range decomposition constraint performs better than those in their own respective method. In this paper, we decompose the maximum step length along the navigation coordinate axes in real time, and establish an ellipsoidal constraint more suitable for actual walking situations. Each sub-constraint changes along with different times and makes the aiding scheme of the step size more specific and accurate. Experimental tests on different paths show that the proposed ellipsoidal constraint method can effectively improve the position accuracy of pedestrian navigation.

Acknowledgments

The authors appreciate the financial support from the Natural Science Foundation of Hunan Province (2015JJ1021 and 14JJ3024).

Author Contributions

Wei Shi verified the algorithm; Yang Wang designed the algorithm and collected the experimental data; Yuanxin Wu guided the manuscript writing. All authors have read and approved the final manuscript.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Akeila, E.; Salcic, Z.; Swain, A. Reducing Low-Cost INS Error Accumulation in Distance Estimation Using Self-Resetting. IEEE Instrum. Meas. 2014, 63, 177–184. [Google Scholar] [CrossRef]
  2. Zhou, X.C.; Chen, J.X.; Dong, Y.; Lu, X.R.; Cui, J.W.; Zheng, B.Y. Pedestrian navigation with foot-mounted inertial sensors in wearable body area networks. In Proceedings of the 2014 Asia-Pacific Signal and Information Processing Association Annual Summit and Conference (APSIPA), Angkor Wat, Cambodia, 9–12 December 2014; pp. 1–4.
  3. Ashkar, R.; Romanovas, M.; Goridko, V.; Schwaab, M.; Traechtler, M.; Manoli, Y. A low-cost shoe-mounted Inertial Navigation System with magnetic disturbance compensation. In Proceedings of the 2013 International Conference on Indoor Positioning and Indoor Navigation, Montbéliard, France, 28–31 October 2013; pp. 1–10.
  4. Jimenez, A.R.; Seco, F.; Prieto, J.C.; Guevara, J. Indoor pedestrian navigation using an INS/EKF framework for yaw drift reduction and a foot-mounted IMU. In Proceedings of the 2010 7th Workshop on Positioning Navigation and Communication, Dresden, Germany, 11–12 March 2010; pp. 135–143.
  5. Skog, I.; Handel, P.; Nilsson, J.O.; Rantakokko, J. Zero-Velocity Detection—An Algorithm Evaluation. IEEE Trans. Biomed. Eng. 2010, 57, 2657–2666. [Google Scholar] [CrossRef] [PubMed]
  6. Nilsson, J.O.; Skog, I.; Handel, P.; Hari, K.V.S. Foot-mounted INS for everybody an open-source embedded implementation. In Proceedings of the 2012 IEEE/ION Position Location and Navigation Symposium (PLANS), Myrtle Beach, SC, USA, 23–26 April 2012; pp. 140–145.
  7. Nilsson, J.O.; Skog, I.; Händel, P. A note on the limitations of ZUPTs and the implications on sensor error modeling. In Proceedings of the 2012 International Conference on Indoor Positioning and Indoor Navigation, Sydney, Australia, 13–15 November 2012; pp. 1–4.
  8. Skog, I.; Nilsson, J.O.; Zachariah, D.; Händel, P. Fusing the information from two navigation systems using an upper bound on their maximum spatial separation. In Proceedings of the 2012 International Conference on Indoor Positioning and Indoor Navigation, Sydney, Australia, 13–15 November 2012; pp. 14–30.
  9. Prateek, G.V.; Girisha, R.; Hari, K.V.S.; Händel, P. Data Fusion of Dual Foot-Mounted INS to Reduce the systematic Heading Drift. In Proceedings of the 2013 International Conference on Intelligent Systems, Vallabh Vidyanagar, India, 1–2 March 2013; pp. 208–213.
  10. Mbalawata, I.S.; Särkkä, S.; Haario, H. Parameter estimation in stochastic differential equations with Markov chain Monte Carlo and non-linear Kalman filtering. Comp. Stat. 2013, 28, 1195–1223. [Google Scholar] [CrossRef]
  11. Choukroun, D.; Bar-Itzhack, I.Y.; Oshman, Y. Novel quaternion Kalman filter. IEEE Trans. Aerosp. Electron. Syst. 2013, 42, 174–190. [Google Scholar] [CrossRef]
  12. Tully, S.; Kantor, G.; Choset, H. Inequality constrained Kalman filtering for the localization and registration of a surgical robot. In Proceedings of the 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems, San Francisco, CA, USA, 25–30 September 2011; pp. 5147–5152.
  13. Jonghoek, K.; Taeil, S.; Ryu, J. Inequality constrained Kalman filter for Bearing-Only Target Motion Analysis. In Proceedings of the 2015 15th International Conference on Control, Automation and Systems, Busan, Korea, 13–16 October 2015; pp. 1607–1611.
  14. Dan, S.; Dan, S. Kalman Filter Constraint Tuning for Turbofan Engine Health Estimation. Eur. J. Control 2006, 12, 331–343. [Google Scholar]
  15. Gupta, N.; Hauser, R. Kalman Filtering with Equality and Inequality State Constraints; Oxford University Computing Laboratory Numerical Analysis Group: Oxford, UK, 2007; pp. 1–26. [Google Scholar]
  16. Simon, B.D. Kalman filtering with state constraints: A survey of linear and nonlinear algorithms. IET Control Theory Appl. 2010, 4, 1303–1318. [Google Scholar] [CrossRef]
  17. Skog, I.; Nilsson, J.O.; Handel, P. Evaluation of zero-velocity detectors for foot-mounted inertial navigation systems. In Proceedings of the 2010 International Conference on Indoor Positioning and Indoor Navigation, Zurich, Switzerland, 15–17 September 2010; pp. 1–6.
  18. Gao, Z.Y.; Li, D.S.; Wang, Y.Z. Combining ZUPT with hybrid particle filter for vehicle MEMS-INS. Electr. Mach. Control 2010, 14, 31–35. [Google Scholar]
  19. Wang, Z.; Zhao, H.; Qiu, S.; Gao, Q. Stance phase detection for ZUPT-aided foot-mounted pedestrian navigation system. IEEE/ASME Trans. Mech. 2015, 1, 3170–3180. [Google Scholar] [CrossRef]
  20. Brand, T.J.; Phillips, R.E. Foot-to-Foot Range Measurement as an Aid to Personal Navigation. In Proceedings of the 59th Annual Meeting of The Institute of Navigation and CIGTF 22nd Guidance Test Symposium, Albuquerque, NM, USA, 23–25 June 2003; pp. 113–121.
  21. Girisha, R.; Prateek, G.V.; Hari, K.V.S.; Händel, P. Fusing the navigation information of dual foot-mounted zero-velocity-update-aided inertial navigation systems. In Proceedings of the 2014 International Conference on Signal Processing and Communications, Gold Coast, Australia, 22–25 July 2014; pp. 1–6.
Figure 1. (Left) The two MIMU are mounted to the feet separately, the OXbYbZb coordinate system are the carrier coordinates; (right) side view, the OXnYnZn coordinate system are the navigation coordinates.
Figure 1. (Left) The two MIMU are mounted to the feet separately, the OXbYbZb coordinate system are the carrier coordinates; (right) side view, the OXnYnZn coordinate system are the navigation coordinates.
Sensors 17 00427 g001
Figure 2. The ellipsoid constraint calibration diagram ( h < γ ).
Figure 2. The ellipsoid constraint calibration diagram ( h < γ ).
Sensors 17 00427 g002
Figure 3. Level constraint for one foot: a circle of radius γ , centered at the other foot.
Figure 3. Level constraint for one foot: a circle of radius γ , centered at the other foot.
Sensors 17 00427 g003
Figure 4. Pedestrian walking a closed path in a corridor outside the laboratory. (a) feet trajectories without constraint; (b) feet trajectories with spherical constraint; (c) feet trajectories with ellipsoidal constraint.
Figure 4. Pedestrian walking a closed path in a corridor outside the laboratory. (a) feet trajectories without constraint; (b) feet trajectories with spherical constraint; (c) feet trajectories with ellipsoidal constraint.
Sensors 17 00427 g004
Figure 5. Left and right feet altitude difference in 2D the closed path experiment. (a) the height difference of the two feet without contraint; (b) the height difference of the two feet with spherical constraint; (c) the height difference of the two feet with ellipsoidal constraint.
Figure 5. Left and right feet altitude difference in 2D the closed path experiment. (a) the height difference of the two feet without contraint; (b) the height difference of the two feet with spherical constraint; (c) the height difference of the two feet with ellipsoidal constraint.
Sensors 17 00427 g005aSensors 17 00427 g005b
Figure 6. The trajectories of the feet in upstairs experiment. (a) feet trajectories without constraint; (b) feet trajectories with spherical constraint; (c) feet trajectories with ellipsoidal constraint.
Figure 6. The trajectories of the feet in upstairs experiment. (a) feet trajectories without constraint; (b) feet trajectories with spherical constraint; (c) feet trajectories with ellipsoidal constraint.
Sensors 17 00427 g006aSensors 17 00427 g006b
Figure 7. The left and right feet position altitude difference in the upstairs experiment. (a) the height difference of the two feet without constraint; (b) the height difference of the two feet with spherical constraint; (c) the height difference of the two feet with ellipsoidal constraint.
Figure 7. The left and right feet position altitude difference in the upstairs experiment. (a) the height difference of the two feet without constraint; (b) the height difference of the two feet with spherical constraint; (c) the height difference of the two feet with ellipsoidal constraint.
Sensors 17 00427 g007
Table 1. The performance parameters of MTI-G-700.
Table 1. The performance parameters of MTI-G-700.
SensorsAccelerometerGyroscope
TypMaxTypMax
Standard full range50 m / s 2 -450 ° / s -
Bias repeatability (1 year)0.03 m / s 2 0.05 m / s 2 0.2 ° / s 0.5 ° / s
In-run bias stability40 μ g -10 ° / h -
Noise density80 μ g / h z 150 μ g / h z 0.01 ° / s / h z 0.015 ° / s / h z
Non-linearity0.03% FS5% FS0.01% FS-
Table 2. RMSE deduction by using the ellipsoidal constraint method for a closed path test.
Table 2. RMSE deduction by using the ellipsoidal constraint method for a closed path test.
Method(L/R) 2D RMSE (m)(L/R) 3D RMSE (m)Remarks
Unconstraint1.2640/0.94931.5473/1.2293Time: 73 s
Distance: 61.6 m
Error rate(%): 0.93
Spherical constraint0.6533/0.61940.8732/0.8482
Ellipsoidal constraint0.5709/0.59530.6977/0.7174
Table 3. RMSE deduction by using ellipsoidal constraint method for indoor upstairs test.
Table 3. RMSE deduction by using ellipsoidal constraint method for indoor upstairs test.
MethodLeft-3D RMSE (m)Right-3D RMSE (m)Remarks
Unconstraint1.67120.8249Time: 157 s
Height: 31.75 m
Error rate(%): 1.71
Spherical constraint0.76760.7874
Ellipsoidal constraint0.65370.5414

Share and Cite

MDPI and ACS Style

Shi, W.; Wang, Y.; Wu, Y. Dual MIMU Pedestrian Navigation by Inequality Constraint Kalman Filtering. Sensors 2017, 17, 427. https://doi.org/10.3390/s17020427

AMA Style

Shi W, Wang Y, Wu Y. Dual MIMU Pedestrian Navigation by Inequality Constraint Kalman Filtering. Sensors. 2017; 17(2):427. https://doi.org/10.3390/s17020427

Chicago/Turabian Style

Shi, Wei, Yang Wang, and Yuanxin Wu. 2017. "Dual MIMU Pedestrian Navigation by Inequality Constraint Kalman Filtering" Sensors 17, no. 2: 427. https://doi.org/10.3390/s17020427

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop