Research Article  Open Access
Xin Li, Yan Wang, Dawei Liu, "Research on Extended Kalman Filter and Particle Filter Combinational Algorithm in UWB and FootMounted IMU Fusion Positioning", Mobile Information Systems, vol. 2018, Article ID 1587253, 17 pages, 2018. https://doi.org/10.1155/2018/1587253
Research on Extended Kalman Filter and Particle Filter Combinational Algorithm in UWB and FootMounted IMU Fusion Positioning
Abstract
As UWB highprecision positioning in NLOS environment has become one of the hot topics in the research of indoor positioning, this paper firstly presents a method for the smoothing of original range data based on the Kalman filter by the analysis of the range error caused by UWB signals in LOS and NLOS environment. Then, it studies a UWB and footmounted IMU fusion positioning method with the integration of particle filter with extended Kalman filter. This method adopts EKF algorithm in the kinematic equation of particle filters algorithm to calculate the position of each particle, which is like the way of running N (number of particles) extended Kalman filters, and overcomes the disadvantages of the inconformity between kinematic equation and observation equation as well as the problem of sample degeneration under the nonlinear condition of the standard particle filters algorithm. The comparison with the footmounted IMU positioning algorithm, the optimizationbased UWB positioning algorithm, the particle filterbased UWB positioning algorithm, and the particle filterbased IMU/UWB fusion positioning algorithm shows that our algorithm works very well in LOS and NLOS environment. Especially in an NLOS environment, our algorithm can better use the footmounted IMU positioning trajectory maintained by every particle to weaken the influence of range error caused by signal blockage. It outperforms the other four algorithms described as above in terms of the average and maximum positioning error.
1. Introduction
With the wide application of indoor positioning technologies in some areas such as supermarket shopping, fire emergency navigation, and hospital patient tracking, indoor positioning can be implemented through the following two approaches. One is based on the various wireless network technologies, such as WiFi (wireless fidelity) [1, 2], RFID (radio frequency identification) [3], and UWB (ultrawideband) [4, 5], which can be used to realize indoor positioning according to the intensity of received signals, the TOA (time of arrival), or TDOA (time difference of arrival). Among all of these technologies, UWB technology can achieve a decimeterlevel positioning precision. However, in some special cases, such as emergency rescue, UWB signals might be blocked by people, walls, or the other barriers in the complex indoor environment. As it might result in the problems of signal multipath effect or intensity attenuation, highprecision positioning can hardly be achieved in NLOS (nonline of sight) environment through the UWB positioning approach.
The other approach is based on the IMU (inertial measurement unit), such as accelerometer, gyroscope, magnetometer, and so on [6], which can be used for positioning according to the integral or the PDR (pedestrian dead reckoning) method. However, this approach has a deficiency, which is an accumulative error. In order to overcome the problem of error accumulation, in [7], the authors proposed ZUPT (zero velocity update) in 2005 to correct the system error and applied it in NavShoe. In 2012, in [8], the authors proposed the implementation of a shoemounted ZUPTaided opensource INS (inertial navigation system) for realtime positioning. At a cost of around USD (United States dollar) 800, this sample system was able to control the navigation error within the range of 0.2%–1% in a short distance (within 100 meters). Moreover, through the analysis of the limitations of ZUPT and the error model [9], they managed to eliminate the drift error according to the optimization algorithm to enhance the algorithm efficiency [10]. In 2013, based on the shoemounted INS, a locally distributed system framework was proposed [11], which could increase significantly the autonomous positioning precision by constraining the course angle deviation of INS in accordance with the distance between both feet. In 2014, Nilsson and his team [12] developed a positioning approach based on the IMU arrays to further increase the reliability and precision of autonomous positioning and at the same time open sourced the experimental positioning platform. In 2017, Wagstaff et al. [13] presented a method to improve the accuracy of a footmounted, zero velocityaided inertial navigation system (INS) by varying the estimator parameters based on a realtime classification of the motion type. By combining the motion classifier with a set of optimal detection parameters, we show how we can reduce the INS position error during mixed walking and running motion. In [14], the authors presented an experimental study on the noise performance and the operating clocksbased power consumption of multiIMU platforms. It is observed that the fourIMU system is best optimized for cost, area, and power.
Although the ZUPT technology to some extent can realize error correction, it still cannot overcome the problem of error accumulation arising in the longdistance positioning for a long time with an IMU. Therefore, the integration of IMU with UWB is a tendency to achieve the highprecision and realtime indoor positioning. With the integration of IMU, not only the following observations such as velocity and direction can be obtained but also the multipath and NLOS effects can be eliminated [15, 16]. In addition, based on the EKF (extended Kalman filter), loose combination can be adopted to track the pedestrian’s movement. In [17], the authors realized the UWB/IMU tightly coupled algorithm based on the EKF and made a comparison with the optical tracking system to show the higher precision. Similarly, in [18], the authors implemented the UWB and inertial data fusion algorithm based on a steady state KF with a fixed gain. The main advantage of this method is that it can be implemented efficiently in lowperformance WSN nodes with lowpower consumption. With the introduction of a tightly coupled algorithm based on UWB/INS, in [19], the authors analyzed the influence of the integrity monitoring algorithms on the positioning performance. In [20], the authors put forward an adaptive fuzzy Kalman filter method. Their experiment turned out that this algorithm outperformed the basic KF algorithm in terms of the positioning result. In [21], the authors designed a tightly coupled GPS (global positioning system)/UWB/INS integrated system based on the adaptive robust Kalman filter. Yet, it is only for outdoor use [22]. It was the first time that the positioning of a flying drone with the integration of vision, IMU, and UWB was proposed to realize the twodimensional positioning accuracy of 10 cm. However, in the literature [23], visualinertial SLAM (simultaneous localization and mapping) technology was used for the positioning of a flying drone. Meanwhile, the adoption of UWB technology for error correction had obtained a full sixDoF pose of the drone. In [24], the authors studied the EKF loosely/tightly coupled UWB/INS integration based on the PDF algorithm, but they utilized the raylaunching simulations to generate UWB data. In [25], the authors presented an improving tightlycoupled navigation model for indoor pedestrian navigation. In the proposed model, a channel filter is used for the estimation of the distance between the reference node (RN) and blind node (BN) measured by the UWB, and then, a 15element error state vector is used in the filter for fusing footmounted IMU and UWB measurements. The real test results show that the proposed model is effective to reduce the error compared with the conventional model, its mean position error has reduced by about 14.81% compared with the UWB only model. In [26], the authors fused an ultrawideband (UWB) sensorbased positioning solution with an inertial measurement unit (IMU) sensorbased positioning solution to obtain a robust, yet, optimal positioning performance. Sensor fusion is accomplished via an extended Kalman filter (EKF) design which simultaneously estimates the IMU sensors’ systematic errors and corrects the positioning errors. Fault detection, identification, and isolation are built into the EKF design to prevent the corrupted UWB sensor measurement data due to obstructions, multipath, and other interferences from degrading the positioning performance. Computer simulation results indicate that more than 100% positioning performance improvement over the UWB sensorbased positioning solution along can be obtained through the proposed sensor fusion solution. In [27], the authors proposed an approach to combine IMU inertial and UWB ranging measurement for relative positioning between multiple mobile users without the knowledge of the infrastructure. They incorporate the UWB and the IMU measurements into a probabilisticbased framework, which allows cooperatively positioning a group of mobile users and recovering from positioning failures.
Most of the above methods have adopted EKF for UWB/INS fusion positioning and optimization. However, the premise for the use of EKF is to assume that both of system errors and observation errors conform to Gaussian distribution. But in the NLOS condition, signal transmission might be affected by barriers due to the blockage or reflection, which would increase the time delay of signal transmission. Under such a circumstance, if the assumption still holds that UWB ranging errors must conform to Gaussian distribution, it would result in great error. In this paper, UWB and IMU fusion positioning has been studied based on the PF (particle filter). This is because that the particle filter can tackle the multimodal distribution of errors. As long as there are sufficient particles available, an approximate globally optimal solution can be obtained effectively. This paper introduces two UWB and IMU fusion algorithms based on the PF and compares them with the other three UWB or IMUbased positioning algorithms for the analysis.
The remainder of the paper is organized as follows: In Section 2, the analysis and pretreatment of UWB data error is illustrated, and Section 3 introduces two UWB and IMU fusion algorithms based on the PF. In order to facilitate the comparison and analysis, it also provides the positioning results based on the footmounted IMU, the optimizationbased algorithm, and the particle filter algorithm based on pure UWB data. Subsequently, several experiments are analyzed in Section 4, and Section 5 concludes the paper.
2. Analysis and Pretreatment of UWB Data Error
In order to verify the UWB data error in LOS and NLOS environment, we carried out a correlation experiment in the entrance hall of School of Computer Science and Technology in China University of Mining and Technology. As shown in Figure 1, the hall is paved with 0.8 ∗ 0.8 m marble tiles so that the calibration of real positions can be made. As indicated in Figure 2, the core chip used in UWB tag/beacon is the DWM1000 chip from DecaWave.
2.1. Analysis of UWB Data Errors in LOS Condition
As shown in Figure 3, it starts from a distance of 2.4 m. Based on a progressive increase of 0.8 m in range, record the distances between the UWB tag and beacon and calculate the relevant errors in Table 1, where it shows that mean error grows with the increase in distance. For example, when the distance is 1.6 m, the mean error is 0.37 m. However, when the distance is increased to 8 m, the mean error reaches 0.56 m. But generally, as indicated in Figure 4, there is a small standard deviation of errors, which also proves that the positioning result is quite stable.

2.2. Analysis of UWB Data Errors in NLOS Condition
As shown in Figure 5, firstly test the influence of the marble column on the UWB signals in the experimental area, where the column is located 1.13 m away from the UWB beacon. It starts from a distance of 3.39 m between the UWB tag and the beacon. Record the distances between the UWB tag and the beacon based on a progressive increase of 0.8 m in distance, and calculate the related errors in Table 2. As shown in Figure 6, there is a significant increase in the mean error with the increase in distance. When the range is 3.39 m, the mean error is 0.62 m. However, the mean error will grow to 3.45 m when the distance is increased to 10.17 m. Please note that when the distance is increased to more than 9.04 m, the laptop that is connected to the UWB beacon can hardly receive any signal after limited groups of range data have been acquired. It reveals that, with the increase in distance, column blockage will lead to an increase in signal attenuation. Actually, when the distance between the tag and the beacon is within 4.52 m, there is a steady change in the ranging result with a standard deviation of 0.04. However, when the distance is greater than 4.52 m, the ranging result will become extremely unstable. There will be a big standard deviation of ranges in the presence of column blockage with the maximum error increased to 4.59 m from 2.01 m.

After that, perform an experiment for the influence of pedestrian blockage on the UWB signals. As shown in Figure 7, it starts from a distance of 1.6 m when the pedestrian moves freely between the beacon and the tag. Then, record the distances between the UWB tag and the beacon based on a progressive increase of 0.8 m in range, and calculate the relevant errors in Table 3. With an increase in distance, the standard deviation of ranges will show a trend of increase first and then decrease. For example, when the distance is below 4.8 m, the standard deviation is around 0.2 m to show a stable ranging result with the maximum error within 1.5 m. However, when the distance is between 5.6 m and 7.2 m, the standard deviation rises quickly. As indicated in Figure 8, big amplitude arises on the corresponding three distance curves, revealing that the ranging results are extremely unstable with the maximum error up to 7.78 m. However, when the distance is over 8.0 m, the ranging result becomes stable again with the standard deviation within 0.3 m. In this experiment, the sudden increase in ranging error always occurs at the moment when the pedestrian moves close to the tag or the beacon. This is because that there is a sudden interference from the pedestrian on the UWB signals. But when the distance goes up to a certain degree, signal diffraction occurs to make the signals free from the influence of pedestrian blockage.

2.3. UWB Data Pretreatment
There is an abnormity in the ranging result, when the UWB signals are shielded by the obstruction or the positioning tag is beyond the detection limit of the UWB beacon. Hence, it is necessary to use the KF (Kalman filter) for the smoothing of range data. Algorithm 1 provides the Kalman filtering process based on the data acquired in four beacons when the pedestrian moves around in the experimental area. Use the KF algorithm to filter every column of UWB data. As indicated in Figures 9 and 10, the filtered UWB range data becomes relatively smoother. In this experiment, the pedestrian walks at a speed of 1.5 m/s, and the UWB data have been collected based on a frequency of 3 Hz. Theoretically, the range difference between two adjacent sampling times must be lower than 0.5 m. However, Figure 11 shows that lots of data are above this threshold due to the multipath effect of UWB data and the column blockage. In addition, the range difference is becoming smaller after the Kalman filtering shown in Figure 12. As indicated in Table 4, there is a reduction in the range difference between two adjacent sampling times in four beacons regarding the mean value, the maximum difference, and the variance.


3. IMU/UWB Fusion Positioning and Analysis
This paper presents a UWB and footmounted IMU fusion positioning method through the integration of the PF with the EKF. In order to verify the algorithm performance, this paper provides the experimental results obtained according to the footmounted IMUbased positioning algorithm, the optimization algorithmbased UWB positioning algorithm, the particle filterbased UWB algorithm, and the particle filterbased IMU/UWB fusion positioning algorithm for the contrast and analysis.
3.1. The FootMounted IMUBased Positioning Algorithm
Fischer et al. [28] put forward a simple but comparatively more precise positioning algorithm based on the footmounted IMU. In summary, their ideas can be concluded into Algorithm 2.

After Line 1 acquires acc_s and , get pitch and roll separately according to the following formula. The value of yaw can be obtained with a magnetometer or through the manual setting:
Horizontally keep the IMU still for 30∼60 seconds to obtain the mean value of the angular velocity noise and take it as the zero bias of , . Also, set up an angular velocity skewsymmetric matrix :
The coordinate transformation matrix C _pre is provided as below:
In Line 9, a new coordinate transformation matrix C will be generated from C _pre and , as soon as there are new data arriving. Then, Lines 10∼12 will calculate current acceleration, velocity, and position vector in the navigation coordinates. The calculation on these three variables has always been made based on the mean value of the states at the moment and the previous moment. This is because that movement process always occurs between two adjacent data points. After that, construct an observation matrix and an observation noise matrix , where the noise values of zero speed detection are used as the observations:
The acceleration skewsymmetric matrix is calculated through the following equation:
Calculate the state transfer matrix and the system error covariance matrix through the following equations:
With the adoption of the direction error, position error, and velocity error as the state values, calculate the error propagation according to the formula provided in Line 14. In Line 15, if a static state is detected, calculate the Kalman gain K first and then, utilize the velocity vector of the current state to calculate the error vector delta_x, which includes the direction error, the position error, and the velocity error. After that, construct an angular error skewsymmetric matrix according to the value of the direction error:
In Line 21, the coordinate transformation matrix is corrected, while Line 22 corrects the current velocity and position value. Line 24 records the directional values in the walking process. Finally, Line 26 returns the positioning result obtained based on the footmounted IMU.
3.2. UWB Positioning Based on the Optimization Algorithm
The UWB databased positioning result can be calculated through the optimization algorithm with constraints, such as LBFGSB. Algorithm 3 gives the computation flow based on the constraint condition that the horizontal position coordinates are within the range of −40 to 40 m. Every time after the range data from the four beacons to the tag is obtained, use the LBFGSB algorithm to calculate the positioning result through the minimization of the cost function. In the cost function algorithm (4), first, calculate the range from each beacon to the current pose and then, sum up this value with the absolute difference of the corresponding range that has been observed. The result can be taken as the return value of the cost function.


3.3. UWB Positioning Based on the PF Algorithm
In order to track the pedestrian’s moving status, this paper adopts the particle filter algorithm for the positioning. The computation flow is provided in Algorithm 5, where the first line is the initialization of the following variables, including the particle number, the initial position, the state noise variance, the evaluation of noise variance, the dynamic array of particle states, the array of particle scores, the weight array, the numerical fusion positioning result, and the array of static beacon coordinates. The state of every particle consists of (x, y), the current position of the particle. Line 2 is the initialization of the particle state. In other words, disperse the particles around the initial position based on the variance sigma1. Lines 3–9 are the course of position tracking based on the particle filter. In Line 4, Gaussian noise is added to the position of every particle in the P_state. Line 5 calculates the weight of every particle based on the range value acquired from the collected UWB data. As described by Algorithm 6, assume that there are n beacons available. Then, calculate the likelihood function of the UWB data observed at the moment according to the variance sigma2 by taking the range from the current particle to a certain beacon as the mean value. Through the multiplication of n likelihood functions, get the product as the weight of the current particle. Line 7 performs the resampling of particle weight to update the particle state based on the value of the resampling.


3.4. IMU/UWB Fusion Positioning Based on the PF Algorithm
As indicated by Algorithm 7, this paper adopts the IMU/UWB fusion positioning to reduce the positioning error caused by the deviation of UWB ranges. Lines 12 are the initialization of the particle number, the initial position, the variance of sampled noise, the evaluation of noise variance, the array of particle states, the array of particle scores, the weight array, the numerical fusion positioning result, and the array of static beacon coordinates. Line 3 utilizes the first 5 groups of UWB data to estimate the pedestrian’s initial position through the triangle method. Centered by the initial position, particles are dispersed randomly based on the variance sigma1 to initialize the array of particle states. Lines 5∼12 give the particle filterbased fusion process based on the ImuPath and UWB data. Line 6 acquires the increment of the trajectory between two adjacent UWB data points based on the ZuptImu algorithm. Line 7 takes the increment of the trajectory as the mean value to sum up the value of the P_state array according to the variance sigma1. Line 8 makes an evaluation on the particle state based on the currently acquired UWB data according to the principle similar to that used in Algorithm 6. Lines 9∼10 indicate the resampling of particles and weight updating with the particle state to be updated based on the resampling value. Line 11 provides the final fused positioning result through the weighted calculation on the weight of the current particle.

3.5. IMU/UWB Positioning Based on the Integration of PF and EKF Algorithm
As indicated by Algorithm 8, this paper presents a positioning method through the integration of the particle filter with the Kalman filter. Lines 12 are the initialization of the following variables, including the IMU data counts, the UWB data counts, the number of particles, the initial position, the initial direction, the variance of state noise, the evaluation of noise variance, the pose of the particle, the score array, the weight array, the dynamic array of particle states, and the array of static beacon coordinates. Every particle consists of the computational nodes on the path of the ZUPTbased footmounted IMU. That is to say, every particle can make the realtime calculation on the movement path according to the EKF algorithm. Lines 3–5 are the initialization of the particle state, or in other words, the estimation on the pose based on the first 20 groups of IMU data at the initial moment. Lines 7–9 indicate that the program quits if the IMU data or UWB data have been read.

The algorithm flow chart is shown in Figure 13.
4. Experiment
The experimental field was established in the entrance hall of School of Computer Science and Technology in China University of Mining and Technology, where the tester had been mounted with an IMU device XIMU produced by a UK company XIO on the foot, with the output frequency of 128 Hz, as shown in Figure 14. The data communication between the UWB positioning system and IMU is shown in Figure 15, in which there are four positioning beacons (Beacon 0∼3) and one positioning tag, they are connected via wireless links, and their ranging data are transmitted to the UWB server by Beacon 0. After the data are preprocessed by the UWB server, they are transmitted to laptop via WiFi. Meanwhile, the IMU data on the foot are also transmitted to laptop via Bluetooth. So, the UWB data and IMU data can be transmitted to laptop for time synchronization. In Figure 15, experimental facilities in the solid box are all carried by testers, in which the tag is installed on a helmet, the IMU is mounted on a foot, and the laptop is held by a tester, as indicated in Figure 16, who walks at a constant velocity.
Three routes have been designed in the experiment. As indicated in Figure 17, there are Route 1, a rectangular route with fewer turns, and Route 2, a polygonal route with more turns. Route 3, as shown in Figure 18, may lose some UWB data during the walking process. There are four beacons established in Figure 17, three beacons established in Figure 18, and their positions are indicated by red dots. Also, in Figures 17 and 18, there were two red blocks representing both of the marble columns in the hall as shown in Figure 1. Three scenarios have been set up in the experiment. The first is the UWB and IMU fused positioning test without any interference from the pedestrian. The second is the UWB and IMU fused positioning test in the context of intentional interference from multiple persons. The third is the experiment performed under the situation of losing some UWB data. The performance and the reliability of the algorithm can be assessed through the calculation of the positioning errors in the various schemes.
4.1. Analysis on the Positioning Paths without Pedestrian Blockage
In the entrance hall of School of Computer Science and Technology, walk along the route marked in red for three circles and along the route marked in blue for two circles as indicated in Figure 17, where the start and end of each route has been marked out. Figures 19 and 20 demonstrate the positioning paths based on the various algorithms with the positioning errors provided in Table 5 after the calculation.

Based on the original IMU data, Scheme I denoted as ZuptImu is indicated by the pink path in Figures 19 and 20. Due to the accumulative error in IMU data, the positioning result obtained based on this scheme will deviate from the real path with the mean error up to 0.987 m and the maximum error at 3.405 m.
Based on the optimization algorithm, Scheme II denoted as OptUwb is indicated by the red path in Figures 19 and 20. As most of the path agrees well with the real trajectory based on this algorithm, big error will arise in the positioning result when signals are blocked. Or in other words, the optimization algorithm fails to converge to the correct result. For example, in Route 2, the maximum positioning error reaches 6.678 m, which indicates that the trajectory has deviated from the real path.
Based on the UWB signals, Scheme III is denoted as PfUwb with the use of the particle filter for the positioning. Based on this scheme, the current positioning result can be corrected according to the range value acquired from the four beacons. With this algorithm, the mean error in Route 1, and Route 2 is separately 0.624 m and 0.527 m. It proves that the positioning result is quite stable.
As indicated in Figures 19 and 20, Schemes IV and V, respectively, denoted as PfImuUwb and PfEkfImuUwb are indicated by the blue and black paths. Both of the schemes can guarantee a stable positioning result in Route 1 and Route 2 with the mean positioning error approximate to that in Scheme III.
4.2. Analysis on the Positioning Path in NLOS Condition
Section 4.1 reveals that all of these three schemes, including PfUwb, PfImuUwb, and PfEkfImuUwb can steadily implement the calculation on the path when there is no interference from the pedestrian. In order to verify the stability of these three algorithms without pedestrian interference, we had three pedestrians to move about in the experimental area. Figures 21 and 22 show the UWB ranges in Route 1 and Route 2 with pedestrian interference. Figures 23 and 24 demonstrate the difference in adjacent ranges from four beacons, revealing that pedestrian blockage will lead to lots of errors in range data. Figures 25 and 26 show the different positioning trajectories obtained based on the various algorithms with the positioning errors provided in Table 6.

In the context of signal interference, great deviation will arise with the PfUwb algorithm. Especially when the pedestrian that causes signal interference is close to the beacon, the sudden change in signal transmission will lead to a big leap in the positioning result. As indicated by the green path in Figures 25 and 26, the mean error is up to 0.696 m in Route 1 with a maximum error of 2.981 m. In Route 2, the mean error reaches 0.587 m and the maximum error is 2.299 m.
As indicted by the blue path in Figures 25 and 26, the PfImuUwb algorithm can alleviate to some extent the positioning error arising in the PfUwb algorithm with the aid of the IMU positioning result. However, this algorithm has very limited deviation correction ability. Therefore, in most cases, the positioning result obtained through this algorithm will be affected by the UWB signals to make the positioning result similar to that through the PfUwb algorithm. For example, the maximum positioning error in Route 1 reaches 2.896 m through this method, and significant distortion can be found on part of the path.
As the PfEkfImuUwb algorithm can utilize every particle to maintain the IMUbased EKF positioning and tracking, the positioning result is equivalent to the integration of several results obtained in multiple positioning paths to weaken the influence from abnormal UWB signals. On this regard, the positioning result through this method is comparatively smoother. Meanwhile, the mean error in Route 1 and 2 is separately 0.624 and 0.527 m, which also proves that this algorithm can guarantee a stable positioning result.
4.3. Analysis on the Positioning Path in NLOS Condition
Route 3 starts from Zone A, passes Point C, and reaches Zone B. With a clockwise walk, it finally goes back to the starting point. As shown in Figure 27, there are two areas where the loss of UWB data occurs during the walking process. One is that when the tester gets to Point C, the data exception of Beacon 3 occurs due to the occlusion of walls, and these abnormal data can be masked by the filtering algorithm. The other is that when the tester walks into Zone B, the ranging signals of Beacons 2 and 3 cannot be received due to the occlusion of walls as well as the increase of distance.
The positioning results of the ZuptImu algorithm and PfEkfImuUwb algorithm are shown in Figure 28. The main disadvantage of the ZuptImu algorithm is that there is a big deviation in direction computation. After turning several corners, the deviation is bigger and bigger, and the final closing error reaches 2.3 m, with an obvious mismatch between positioning trajectories and actual trajectories. But, in the PfEkfImuUwb algorithm, each particle maintains EKF positioning and tracking based on the IMU, which guarantees a small motion deviation of each particle. Under the situation of losing some UWB data, the motion angle at the point of error particles is corrected through the constraint of only one UWB beacon in Zone B and the ranging constraint of two UWB beacons when passing through the straight line of Point C, with a almost overlap between positioning trajectories and actual trajectories.
5. Conclusions
This paper presents a UWB and footmounted IMU fusion positioning method through the integration of PF with EKF. Although this algorithm can achieve good positioning result in the context of pedestrian blockage, it needs to be further improved and perfected in terms of the followings: on the one hand, as path calculation based on the EKF is maintained by every particle, it undoubtedly will increase the computational burden, which can be solved through the parallel algorithm; on the other hand, some variables that are deduced from the IMU algorithm, such as velocity, acceleration, angle, and angular velocity, can be added into the particle state, and since they are equivalent to the addition of a constraint of uniform change, a better effect can be achieved theoretically. This positioning is based on the detection method of ArUCO beacons, and its accuracy can reach about 7 cm after optimization of the backend system [29]. At present, this algorithm is still under study.
Conflicts of Interest
The authors declare that there are no conflicts of interest regarding the publication of this paper.
Authors’ Contributions
The corresponding author Yan Wang proposed the research and was involved in the writing of the manuscript. Xin Li designed the experiment, performed the data analysis, and drafted the manuscript. Dawei Liu was responsible for data collection and was involved in data processing.
Acknowledgments
This work was supported by the National Natural Science Foundation of China under Grant no. 41674030, China Postdoctoral Science Foundation under Grant no. 2016M601909, and grant of China Scholarship Council.
References
 X. Li, J. Wang, C. Liu, L. Zhang, and Z. Li, “Integrated WiFi/PDR/smartphone using an adaptive system noise extended Kalman filter algorithm for indoor localization,” ISPRS International Journal of GeoInformation, vol. 5, no. 2, p. 8, 2016. View at: Publisher Site  Google Scholar
 X. Li, J. Wang, and C. Liu, “A Bluetooth/PDR integration algorithm for an indoor positioning system,” Sensors, vol. 15, no. 10, pp. 24862–24885, 2015. View at: Publisher Site  Google Scholar
 R. Mautz, “The challenges of indoor environments and specification on some alternative positioning systems,” in Proceedings of the Workshop on Positioning, Navigation and Communication (WPNC 2009), pp. 29–36, Hannover, Germany, March 2009. View at: Google Scholar
 J. Chóliz, A. Hernández, and A. Valdovinos, “A framework for UWBbased communication and location tracking systems for wireless sensor networks,” Sensors, vol. 11, no. 9, pp. 9045–9068, 2011. View at: Publisher Site  Google Scholar
 F. Zampella, A. D. Angelis, I. Skog, and D. Zachariah, “A constraint approach for UWB and PDR fusion,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation, vol. 41, pp. 1–9, Sydney, NSW, Australia, November 2012. View at: Google Scholar
 D. Gusenbauer, C. Isert, and J. Krosche, “Selfcontained indoor positioning on offtheshelf mobile devices,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation (IPIN 2010), pp. 1–9, Zurich, Switzerland, 2010. View at: Google Scholar
 E. Foxlin, “Pedestrian tracking with shoemounted inertial sensors,” IEEE Computer Graphics and Applications, vol. 25, no. 6, pp. 38–46, 2005. View at: Publisher Site  Google Scholar
 J. O. Nilsson, I. Skog, P. Handel, and K. V. S. Hari, “Footmounted INS for everybody—an opensource embedded implementation,” in Proceedings of the IEEE/ION Plans 2012, vol. 1, pp. 140–145, Myrtle Beach, SC, USA, April 2012. View at: Google Scholar
 J. O. Nilsson, I. Skog, and P. Händel, “A note on the limitations of ZUPTs and the implications on sensor error modeling,” Signal Processing, 2012. View at: Google Scholar
 J. O. Nilsson and P. Händel, “Standing still with inertial navigation,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation (IPIN), Montbéliard, France, October 2013. View at: Google Scholar
 J. O. Nilsson, D. Zachariah, I. Skog, and P. Händel, “Cooperative localization by dual footmounted inertial sensors and interagent ranging,” EURASIP Journal on Advances in Signal Processing, vol. 2013, no. 1, pp. 164–181, 2013. View at: Publisher Site  Google Scholar
 I. Skog, J. O. Nilsson, and P. Händel, “Pedestrian tracking using an IMU array,” in Proceedings of the IEEE International Conference on Electronics, Computing and Communication Technologies, pp. 1–4, IEEE, January 2014. View at: Google Scholar
 B. Wagstaff, V. Peretroukhin, and J. Kelly, “Improving footmounted inertial navigation through realtime motion classification,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation (IPIN 2017), Sapporo, Japan, September 2017. View at: Google Scholar
 B. Subhojyoti, K. Amit, and P. Gupta, “On the noise and power performance of a shoemounted multiIMU inertial positioning system,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation (IPIN 2017), Sapporo, Japan, September 2017. View at: Google Scholar
 S. Sczyslo, J. Schroeder, S. Galler, and T. Kaiser, “Hybrid localization using UWB and inertial sensors,” in Proceedings of the IEEE International Conference on UltraWideband (ICUWB 2008), vol. 3, pp. 89–92, Hanover, Germany, September 2008. View at: Google Scholar
 S. Pittet, V. Renaudin, and B. Merminod, “UWB and MEMS based indoor navigation,” Journal of Navigation, vol. 61, no. 3, pp. 369–384, 2008. View at: Publisher Site  Google Scholar
 J. D. Hol, F. Dijkstra, H. Luinge, and T. B. Schon, “Tightly coupled UWB/IMU pose estimation,” in Proceedings of the IEEE International Conference on UltraWideband (ICUWB 2008), pp. 688–692, Vancouver, BC, Canada, September 2009. View at: Google Scholar
 A. Savioli, E. Goldoni, P. Savazzi, and P. Gamba, “Low complexity indoor localization in wireless sensor networks by UWB and inertial data fusion,” Computer Science, vol. 52, no. 4, pp. 723–732, 2013. View at: Google Scholar
 C. Ascher, L. Zwirello, T. Zwick, and G. Trommer, “Integrity monitoring for UWB/INS tightly coupled pedestrian indoor scenarios,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation (IPIN 2011), pp. 1–6, Guimarães, Portugal, September 2011. View at: Google Scholar
 Q. Fan, Y. Wu, J. Hui, L. Wu, Z. Yu, and L. Zhou, “Integrated navigation fusion strategy of INS/UWB for indoor carrier attitude angle and position synchronous tracking,” Scientific World Journal, vol. 2014, Article ID 215303, 13 pages, 2014. View at: Publisher Site  Google Scholar
 J. Wang, Y. Gao, Z. Li, X. Meng, and C. M. Hancock, “A tightlycoupled GPS/INS/UWB cooperative positioning sensors system supported by V2I communication,” Sensors, vol. 16, no. 7, p. 944, 2016. View at: Publisher Site  Google Scholar
 A. Benini, A. Mancini, and S. Longhi, “An IMU/UWB/visionbased extended Kalman filter for miniUAV localization in indoor environment using 802.15.4a wireless sensor network,” Journal of Intelligent and Robotic Systems, vol. 70, no. 1–4, pp. 461–476, 2013. View at: Publisher Site  Google Scholar
 H. E. Nyqvist, M. A. Skoglund, G. Hendeby, and F. Gustafsson, “Pose estimation using monocular vision and inertial sensors aided with ultra wide band,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation (IPIN 2015), pp. 1–10, Banff, AB, Canada, October 2015. View at: Google Scholar
 L. Zwirello, C. Ascher, G. F. Trommer, and T. Zwick, “Study on UWB/INS integration techniques,” in Proceedings of the Workshop on Positioning Navigation and Communication (WPNC 2011), pp. 13–17, Dresden, Germany, April 2011. View at: Google Scholar
 Y. Xu, X. Chen, J. Cheng, Q. Zhao, and Y. Wang, “Improving tightlycoupled model for indoor pedestrian navigation using footmounted IMU and UWB measurements,” in Proceedings of the Instrumentation and Measurement Technology Conference (I2MTC 2016), IEEE, Taipei, Taiwan, May 2016. View at: Google Scholar
 Y. Leehter, W. Yeong, and W. Andy, “An integrated IMU and UWB sensor based indoor positioning system,” in Proceedings of the International Conference on Indoor Positioning and Indoor Navigation (IPIN), Sapporo, Japan, September 2017. View at: Google Scholar
 R. Liu, C. Yuen, T. N. Do, D. Jiao, X. Liu, and U. X. Tan, “Cooperative relative positioning of mobile users by fusing IMU inertial and UWB ranging information,” in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA 2017), pp. 5623–5629, IEEE, Piscataway, NJ, USA, 2017. View at: Google Scholar
 C. Fischer, P. T. Sukumar, and M. Hazas, “Tutorial: implementing a pedestrian tracker using inertial sensors,” IEEE Pervasive Computing, vol. 12, no. 2, pp. 17–27, 2013. View at: Publisher Site  Google Scholar
 J. Bacik, F. Durovsky, P. Fedor, and D. Perdukova, “Autonomous flying with quadrocopter using fuzzy control and ArUco markers,” Intelligent Service Robotics, vol. 10, no. 3, pp. 185–194, 2017. View at: Publisher Site  Google Scholar
Copyright
Copyright © 2018 Xin Li et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.