Research on Extended Kalman Filter and Particle Filter Combinational Algorithm in UWB and Foot-Mounted IMU Fusion Positioning

As UWB high-precision 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. -en, it studies a UWB and foot-mounted IMU fusion positioning method with the integration of particle filter with extended Kalman filter. -is 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. -e comparison with the foot-mounted IMU positioning algorithm, the optimization-based UWB positioning algorithm, the particle filter-based UWB positioning algorithm, and the particle filter-based 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 foot-mounted 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.


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 (ultra-wideband) [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 decimeter-level 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, high-precision positioning can hardly be achieved in NLOS (nonline of sight) environment through the UWB positioning approach.
e 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 shoe-mounted ZUPT-aided open-source INS (inertial navigation system) for real-time 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 shoe-mounted 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 foot-mounted, zero velocity-aided inertial navigation system (INS) by varying the estimator parameters based on a real-time 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 clocks-based power consumption of multi-IMU platforms.It is observed that the four-IMU 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 long-distance positioning for a long time with an IMU.erefore, the integration of IMU with UWB is a tendency to achieve the high-precision and real-time 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.e main advantage of this method is that it can be implemented efficiently in lowperformance WSN nodes with low-power 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.eir 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], visual-inertial 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 six-DoF 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 ray-launching simulations to generate UWB data.In [25], the authors presented an improving tightly-coupled 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 15-element error state vector is used in the filter for fusing foot-mounted IMU and UWB measurements.e 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 ultra-wideband (UWB) sensor-based positioning solution with an inertial measurement unit (IMU) sensor-based 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 sensor-based 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.
ey incorporate the UWB and the IMU measurements into a probabilistic-based 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). is 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.is paper introduces two UWB and IMU fusion algorithms based on the PF and compares them with the other three UWB or IMU-based positioning algorithms for the analysis.e 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 2 Mobile Information Systems comparison and analysis, it also provides the positioning results based on the foot-mounted 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.

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.

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.

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.ere 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.en, 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

Mobile Information Systems
when the pedestrian moves close to the tag or the beacon.is 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 di raction occurs to make the signals free from the in uence of pedestrian blockage.

UWB Data Pretreatment.
ere 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 lter) for the smoothing of range data.Algorithm 1 provides the Kalman ltering process based on the data acquired in four beacons when the pedestrian moves around in the experimental area.Use the KF algorithm to lter every column of UWB data.As indicated in Figures 9 and 10, the ltered 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      eoretically, the range di erence 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 e ect of UWB data and the column blockage.In addition, the range di erence is becoming smaller after the Kalman ltering shown in Figure 12.As indicated in Table 4, there is a reduction in the range di erence between two adjacent sampling times in four beacons regarding the mean value, the maximum di erence, and the variance.

IMU/UWB Fusion Positioning and Analysis
is paper presents a UWB and foot-mounted 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 foot-mounted IMU-based positioning algorithm, the optimization algorithm-based UWB positioning algorithm, the particle lter-based UWB algorithm, and the particle lter-based IMU/UWB fusion positioning algorithm for the contrast and analysis.

e Foot-Mounted IMU-Based Positioning Algorithm.
Fischer et al. [28] put forward a simple but comparatively more precise positioning algorithm based on the foot-mounted IMU.In summary, their ideas can be concluded into Algorithm 2.
After Line 1 acquires acc_s and gyro_s, get pitch and roll separately according to the following formula.e value of yaw can be obtained with a magnetometer or through the manual setting: roll a tan acc s(2,1) acc s(3,1) , yaw init_heading. ( 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 gyro, gyro_bias.Also, set up an angular velocity skew-symmetric matrix S w : e 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 S w , as soon as there are new data arriving.en, Lines 10∼12 will calculate current acceleration, velocity, and position vector in the navigation coordinates.e calculation on these three variables has always been made based on the mean value of the states at the moment and the previous moment.is is because that movement process always occurs between two adjacent data points.After that, construct an observation matrix H and an observation noise matrix R,

Mobile Information Systems
where the noise values of zero speed detection are used as the observations: e acceleration skew-symmetric matrix S a is calculated through the following equation: −acc_n( 2) acc_n( 1) 0 Calculate the state transfer matrix F and the system error covariance matrix Q 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 rst 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 S e according to the value of the direction error: −attitude_error(3, 1) attitude_error(2, 1) −attitude_error(2, 1) attitude_error(1, 1) 0 6 Mobile Information Systems In Line 21, the coordinate transformation matrix C 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 foot-mounted IMU.

UWB Positioning Based on the Optimization Algorithm.
e UWB data-based positioning result can be calculated through the optimization algorithm with constraints, such as L-BFGS-B.Algorithm 3 gives the computation ow 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 L-BFGS-B algorithm to calculate the positioning result through the minimization of the cost function.In the cost function algorithm (4), rst, calculate the range from each beacon to the current pose and then, sum up this value with the absolute di erence of the corresponding range that has been observed.e result can be taken as the return value of the cost function.

UWB Positioning Based on the PF Algorithm.
In order to track the pedestrian's moving status, this paper adopts the particle lter algorithm for the positioning.e computation ow is provided in Algorithm 5, where the rst 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.e 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 lter.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.en, calculate the likelihood function of the kth 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.rough 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.

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 1-2 are the initialization of the particle number, the initial position, the variance of sampled noise, the evaluation of noise    Mobile Information Systems 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.

Mobile Information Systems
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 filter-based 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.

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 1-2 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 End (10) If time(UwbData(uwb_index)) > time(ImuData(imu_index)) (11) For i in particle_num (12) pose[i] � Ekf_List [i].get_Position(add_Noise(ImuData,ZuptData, sigma1)) (13) End ( 14) imu_index++ ( 15) Else (16) For i in particle_num (17) score For i in particle_num (22) pose_fusing  Mobile Information Systems of particle states, and the array of static beacon coordinates.Every particle consists of the computational nodes on the path of the ZUPT-based foot-mounted IMU. at is to say, every particle can make the real-time calculation on the   Mobile Information Systems 11 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 rst 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.e algorithm ow chart is shown in Figure 13.

Experiment
e experimental eld 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 X-IMU produced by a UK company X-IO on the foot, with the output frequency of 128 Hz, as shown in Figure 14. e 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.ree 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.
ere are four beacons    e third is the experiment performed under the situation of losing some UWB data.e performance and the reliability of the algorithm can be assessed through the calculation of the positioning errors in the various schemes.

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

14
Mobile Information Systems 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.

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.erefore, 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 IMU-based 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  Mobile Information Systems separately 0.624 and 0.527 m, which also proves that this algorithm can guarantee a stable positioning result.

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.e 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.e positioning results of the ZuptImu algorithm and PfEkfImuUwb algorithm are shown in Figure 28.e 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 PfEkfI-muUwb 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.

Conclusions
is paper presents a UWB and foot-mounted 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.
is 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.

Figure 1 :
Figure 1: e experimental area in the entrance hall.

Figure 3 :
Figure 3: Ranging test in LOS condition.

Figure 4 :
Figure 4: Ranging results in LOS condition.

Figure 16 :Figure 17 :Figure 18 :Figure 19 :
Figure 16: Experiment with a laptop in the hand.

Figure 21 :Figure 22
Figure 21: e UWB ranges in Route 1 under the interference.

Table 1 :
Ranging errors in LOS condition based on a progressive increase of 0.8 m in distance.

Table 3 :
Ranging results based on a progressive increase of 0.8 m in distance with pedestrian blockage.
Figure 8: Ranging results with column blockage.

Table 5 :
Error comparison and analysis based on the ve algorithms.

Table 6 :
Error comparison and analysis based on the three approaches.