Grid-Based Improved Maximum Likelihood Estimation for Dynamic Localization of Mobile Robots

The dynamic localization is a kind of technology by which the mobile robot tries to localize the position by itself. According to the dynamic localization failure of mobile robots in indoor network blind areas, an autonomous-dynamic localization system which dynamically chooses beacon node and establishes grids is proposed in this paper. This method applies received signal strength indication (RSSI) for distance measurement. Furthermore, the proposed grid-based improved maximum likelihood estimation (GIMLE) fulfills the localization. Finally, the localization error correction is implemented by Kalman filter. The approach combines the classical Kalman filter with the other localization algorithms. The purpose is to smooth and optimize the results of the algorithms, in order to improve the localization accuracy. In particular, in network blind spots, the Kalman filter provides better performance than the other algorithms listed in the paper. Experimental results show the accuracy, adaptivity, and robustness of the dynamic self-localization of mobile robots.


Introduction
Dynamic localization of the mobile robot is the frontier research area in wireless sensor networks (WSNs). WSNs could fulfill dynamic ad hoc networking in the situation of partial damaged nodes and provide consecutive environmental information and changing trend data for the robot in a disaster rescue system, so as to ensure the perception and rescue capability of the robot.
The mobile robot regards itself as the active node, dynamically senses network environment nearby, and achieves selflocalization in WSNs. Because of its widespread application prospect, it has become the most advanced research field in the world. The literature [1], which studies less environmental information scene, utilizes global positioning algorithm to form multiple hypotheses problem of robot position, presents a kind of unified framework, and obtains a group of only state of robots based on map structure and measurement information among robots; the algorithm maximizes the estimated position of a group of robots which could only gain hypotheses, and it is proved to help the nonpositioning robots overcome differences. The document [2], which studies the situation that the map of nonstatic environment is too simple and lacks information, proposes a robust position tracking method for mobile robots. The algorithm uses the nondamaged window sample and completes the robustness estimation in the condition of badly damaged observation. Through the comparison with all particles, sample particles comprise plenty of undamaged sets and give the weight values. Nonlinear constrained least-squares optimization is used to correct the errors. The document [3], which studies the phenomenon that RSSI positioning system is seriously affected by obstacles, proposes an improved localization algorithm that can divide the network area into relatively small grids, and maximum likelihood estimation is utilized to calculate the probability density of each grid location. In order to inspect the errors caused by obstacles, the algorithm introduces Min/Max method and specifies boundaries of positioning estimation area. The positioning errors can be corrected by compensating RSSI value. The document [4] studies various factors that interfere with range measurement and proposes a Chirp Spread Spectrum (CSS) based mobile 2 International Journal of Distributed Sensor Networks robot localization method. The algorithm implements the range measurement between mobile robot and CSS beacon node according to the flight time of the radio signals; based on the distance data obtained, robot localization is realized by trilateration estimation. Range measurement noise is smoothed by extended Kalman filter (EKF); meanwhile the proportional factor is introduced to handle ranging bias. The method needs to compute the complex proportional factor and be very difficult to calculate. The literature [5] researches position errors during the motion of mobile robots and proposes a new localization algorithm using gyroscope and Kalman filter; the method uses physical constrained parameters provided by general constrained optimization technique. The additional state variables are utilized to improve the state observability, the nonapproximated Kalman filter design is applied for improving the accuracy, and the odometry errors are effectively compensated. Document [6] studies the output-noise covariance matrix in mobile robot localization algorithm and proposes the usage of laser range finder for Kalman filter localization algorithm. The method represents an environment with line segments; then the extended Kalman filter algorithm (EKF) is used to realize positioning. Furthermore, the covariance of the observed environment lines including the output-noise covariance matrix of the EKF, estimation of the covariance of the line parameters based on classic least squares (LSQ), is less computationally complex and more efficient than the orthogonal LSQ. The literature [7] research performance analysis of NLOS scenario proposes the CRLB algorithm in two NLOS situations; the method is suitable for all the noise distribution. The literature [8] provides the solution of the robot body survival and adaptation ability, which is suitable for robot control station in disaster rescue system. To improve the overall performance of the system is of great significance.
The literatures [1,2,6] all need to include environmental information map beforehand in order to assist robot of selflocalization; adaptability is poor for unknown environment. The literatures [3,4,7] study localization scenario of the non-line-of-sight, but they cannot be applied to the network environment with insufficient beacon nodes. In order to ensure the effectiveness of trilateration estimation, literature [4] needs at least three beacon nodes for localization, which are unable to adapt to network blind spots without enough beacon nodes. The paper [5] ignores the influence factors of temperature for the gyroscope; the experimental results need further research. The paper [8] only puts forward design principles of human-machine interaction and does not give specific sense methods for robot.
For large errors and high calculation cost of grid-based maximum likelihood estimation (GMLE), beacon nodes are dynamically selected to improve the grid space in this paper; then for the special case like network blind areas, Kalman filtered grid-based improved maximum likelihood estimation (KGIMLE) is proposed, which carries out dynamic self-localization of the mobile robot. The simulation and experimental results show that the proposed algorithm can effectively reduce the measurement noise and positioning error, especially in the poor node deployment of network blind areas; adaptability and robustness of the positioning results are ensured.

RSSI Range Measurement Model
Since wireless signal strength emitted periodically by wireless sensor is decreasing while the propagation distance increases, under the premise of the known transmitted and received signal strength, the signal strength loss is converted into a distance through the mathematical model, in order to estimate the distance between the sending node and the receiving node.
According to various practical application environments, RSSI range measurement shows different features, especially in the dense deployment of WSNs; the complex problems such as reflection and multipath propagation emerge endlessly. In the process of simulation, the following empirical formula is used [9]: in which 0 ( 0 ) is the reference signal strength of distance 0 away from the transmitter; is the signal propagation path fading coefficient, which is corresponding with a specific environment; is the normal distribution of random variable caused by shading effect.
According to the experiment requirement, 0 ( 0 ) is set to −41.1 dBm; the value of is 3; 0 is 1 m; is Gaussian white noise distribution of the random noise with mean value 0 and variance 4.
As shown in Figure 1, with the increase of RSSI transmission distance, signal intensity weakens. The smooth curve is the ideal RSSI measurement values that are not affected by the environment noise and errors of impedance of hardware. In the ideal case, the RSSI ranging error is 0, and the measuring distance and real distance are perfectly matched. But the truth coefficient is affected by the outside world and their own equipment; there is a big measurement error; the irregular curve in the figure shows the scenario that the RSSI measurements are irregular fluctuations under the condition of nonoptimization. And all the values are negative. Because of the distance of 1 m, the signal intensity has been negative already.
Besides the range measurement of RSSI, there are many other wireless signals with radio frequency of 2.4 GHz, such as TOA [10,11], Wi-Fi, and Bluetooth, which can be utilized in the buildings as an alternative of GPS positioning. Considering the weakness of the ranging information of RSSI, literature [12,13] has further discussion on the rangefree issues. The connectivity topology of wireless sensor networks provides the crucial information of localization. The connection link constrains the node position aside from the link and the estimated position information can be achieved.

Grid-Based Improved Maximum Likelihood Estimation
3.1. Algorithm Improvement. Among the node localization algorithms in WSNs, one of the most precise algorithms is maximum likelihood estimation (MLE). There are more application technologies in view of MLE, among the more famous methods; [3] divides network area into several grids, calculates the probability value of each grid, and implements MLE.
The proposed GIMLE algorithm in this paper has improved [3] in three points. Firstly, GIMLE has been applied to the self-localization of mobile robots successfully instead of static node positioning. Secondly, the grid area is dynamically changed based on the position of mobile robots in each sampling time. Last but not least, compared with the network diameter 50 m∼150 m in [3], the grid area is reasonably smaller since the effective communication radius of robots is limited. Furthermore, due to the limited grid area, the size of the grid unit is accurate to 0.01 m 2 . This paper is aimed at the moving trajectory of the mobile robot, because of instantaneous stationary at each sampling time; the mobile robot can be seen as static unknown nodes, and, then, MLE algorithm is established based on the grid probability value. The algorithm looks forward the position information of the beacon node, which is nearest to the mobile robot at a certain time interval point, as the center coordinates, and divides WSNs area around the robot into × m 2 squares; is effective communication radius for the robot. It chooses a square as the basic shape of network area division, aimed at achieving seamless connection across cell boundaries easily for computing. The coordinate for the center of a square is that = Node | node = min ( node 1 , node 2 , . . . , node ) , (2) in which is the square center around the robot, Node is the beacon node, which is closest to the robot, and node is the shortest estimated distance among detected n beacon nodes to robot.
Since the research area of this paper is focused on indoor localization of mobile robots, the room space is limited compared with the range threshold 15 m of radio frequency signal. The situation of connection failure between the robot and beacon nodes is very rare, while the robot is moving inside the building and the deployment of beacon nodes is prearranged. Even though the connection failure can be caused by physical damage or limited power, Kalman filter algorithm which is suitable for network blind spots in latter section is applicable to handle this scenario.
The actual square area is based on WSNs environment; once the robot moves to the network boundary, the boundary is used as the actual rectangular boundary. In order to improve the positioning precision, 0.01 m 2 is for the unit and the rectangular area is divided into several grid units. The probability distribution function (PDF) of each grid is calculated separately. Finally, MLE algorithm selects the maximum PDF value of grid centroids as the estimated location coordinates: in which the grid area is divided into 0.01 m 2 square; is the square centroid around the robot. ( | ) is the PDF value of each grid centroid to the th node coordinate among beacon nodes.
In the grid area centered by the beacon node nearest to the mobile robot, each grid has its own independent centroid point coordinates. Due to the fact that the robot is moving, the grid area around the robot has been dynamically changed. Combined with robot coordinates and function relation between the communication radiuses of robot with the outside world, the grid centroid coordinate is determined. With the robot coordinate, the network area covered by a specific communication radius can be identified. 0.01 m 2 is as a unit; the area can be divided into fixed matrix rows and columns of the grid; any th row and th column cell of the matrix can be located. Then, the centroid coordinate of the grid unit can be identified: in which and are the horizontal and vertical axis direction subscript of the square center in the grid area. and are the actual horizontal and vertical coordinate of the beacon node closest to the robot.
The probability distribution function is the method of probability theory and applies to the probability rule of random errors. There are different probability distribution forms according to the different random variable types. The distribution function value is the real number of greater than or equal to zero and less than or equal to 1. The distribution International Journal of Distributed Sensor Networks function is the right continuous function of monotonic nondecreasing property; the negative infinity is 0; the positive infinity is 1. In this paper, the noise mathematical model of range measurement is Gaussian white noise. The probability distribution function is that in which is the difference of RSSI value between the grid unit and the robot received from th beacon node, is the mean value of Gaussian white noise, 2 is the variance, and in which is the distance between the grid unit and th beacon node. ( ) is the RSSI value defined by (1). rssi robot is the RSSI value between the robot and th beacon node. In simulation experiment, the RSSI value is obtained by (1). In CC2530-based experiment, the RSSI value is achieved from received signal of th beacon node. The reason for Gaussian distribution used in (5) is that the RSSI values come from (1), which obeys Gaussian distribution. Figure 2 depicts the process of location estimation algorithm. The robot first collects coordinate information of surrounding beacon nodes in the network environment and measures estimated distances between the robot and beacon nodes. Centered on the beacon node closest to the robot, the algorithm establishes a fixed radius length of grid area. The unit is 0.01 m 2 . Then, from the first cell to the last cell, the probability of becoming estimation location of the robot for each cell centroid is calculated. The method is that it measures the probability distribution function between cells and each beacon node, multiplies function value together, and obtains the final probability distribution density of the cell. Finally, MLE algorithm selects the cell centroid with the maximum probability distribution density as the estimated coordinates of the robot.

Model Analysis.
There are two kinds of arrows in the figure, dashed and solid. The solid arrows display that the robot can receive RSSI from beacon nodes. In the meantime, the dashed arrows show that each grid unit, which is an alternative to estimated location of the robot, can simulate the RSSI values of beacon nodes.
As shown in the figure, due to the distance measurement noise and environmental factors, there is often a deviation between the actual location of the robot and estimated position; it makes up the positioning error. The positioning error reduction can be realized through various means. In this paper, the research idea is very new. In order to minimize the possible area of robot in the process of positioning, a grid area centered by the sensor is built up around the actual location of the robot, as an estimation range of the robot position. By limiting the area of search calculation, on the one hand, the positioning accuracy is improved and the range of the positioning error offset is reduced; on the other hand,   the computation cost, the computing burden of sensor processor, and the energy consumption are reduced.
The deployment of beacon nodes in WSNs is randomness. Particularly in disaster situations, the destructive factors such as fire, earthquake, and explosion are easy to cause the physical failure and position change of sensor nodes. WSNs may be mutations, have to rebuild the network, and build a new network topology structure. In this paper, the symmetry problem, which means the probability distribution densities may be the same, is avoided mostly for GIMLE algorithm; the effectiveness and robustness of the algorithm are ensured.
When the mobile robot moves to the middle of the network area with symmetry nodes deployment, the localization result of GMLE shown in Figure 3, there is error between the estimated and true position of the robot. After many experiments, the uncertainty of the error is confirmed. Therefore, under the condition of the absolute symmetry nodes deployment, positioning result of GMLE is not failed due to environmental constraints.
As a result of the existence of ranging error between sensor nodes and the effects of environmental noise, GMLE algorithm can realize the robustness in the symmetry of the network environment. When there is a distance measurement noise, the probability distribution density of the grid has the characteristics of being asymmetric. When the robot moves to the symmetry center position of the network, the 5 m radius square of the grid area around the robot is selected. Each cell in Figure 1 represents the corresponding coordinates of the grid area. The cell value is the probability distribution density of the grid. As shown in Figure 4, the values of probability distribution density emerge as an irregular change phenomenon. This is caused by ranging error according to the random change of Gaussian white noise. Because of the randomness of noise, the probability distribution density is random. Furthermore, the distribution area of probability distribution density is concentrated; GMLE algorithm can rapidly converge to estimate position assuringly.
Under the ideal condition of removing the range measurement and the surrounding environment noise disturbance factors, GMLE algorithm appears symmetry effect, as shown in Figure 5. In the coordinate system of the fixed area, the probability distribution density of the grid is uniform distribution with the characteristics of centrosymmetry; the maximum likelihood values of probability distribution density appear in the adjacent square area at the same time. Since there is no single value, the localization algorithm has the position deviation. As long as there is no noise, symmetry phenomenon has been around. But, in the real environment, ranging error and environmental noise are inevitable; similar situation will not appear.

Kalman Filtering Algorithm Suitable for Network Blind Spots
When the mobile robot moves in WSNs environment with plenty of beacon nodes, GIMLE algorithm can provide highprecision positioning with small error. However, when the mobile robot moves into the WSNs with poor beacon nodes, the localization result of GIMLE algorithm will be serious distortion; the entire estimated positions even lead to grave deviation from the true locations. Therefore, this paper proposes Kalman filtering algorithm in view of the network blind area; the algorithm can fulfill localization in the case of smaller error.  This paper modifies the sensor ranging observation equation of the mobile robot; the calculation results of any existing localization algorithm, as the measurement data, can be led directly to the observation equation, which reduces the complexity of the mathematical model and computational costs. The Kalman filter positioning algorithm is improved from an independent localization to a joint optimization one; the complex discrete state equation is improved to be a simple linear state equation, and it is one of the main contributions of this paper. Robot measurement equation can be expressed as in which ∈ is the interval measurement vector of the th sampling time of the sensor carried by the robot; Point is Because the prediction coordinatê/ of the mobile robot's actual coordinate / can be calculated by and +1/ ,̂/ and new measurement +1 can together predict the next moment coordinate; this makes iterative recursive filtering algorithm. The state equation which makes the prediction of + 1th moment by th moment is that in which is the state transition matrix [1, V; 0, 1], V is the velocity of robots in either horizontal or vertical direction, is the control weighted matrix 1 in either horizontal or vertical direction, is a control signal, and in which / is the horizontal or vertical coordinate of robots; is the unit of time of the robot moving.
When the new measurement localization data arrives, in which +1 is the filter gain, +1 is the parameter matrices of the observation equation, +1 is given by the principle of minimum variance, and in which is the Gaussian white noise covariance of measurement; the prediction error variance matrix of +1/ is that in which / is constant [1, 1; 1, 1] for both horizontal and vertical coordinates. The error variance matrix̂+ 1/ +1 predicted by +1/ +1 is that Currently the algorithm applied in the field of mobile robot localization technology is difficult to realize the effective localization of WSNs environment; there is often serious localization deviation in cases of special network. For that, this improved Kalman filtering algorithm increases the mechanism of predictive control and effectively avoids the phenomenon of large errors; the optimization results of localization are close to the real state and parameter values constantly. The control equations are that in which +1/ is the iterative control signal; is the control precision 0.001; is the unit step length of the mobile robot. If there is still a serious distortion when the robot localization coordinates are processed by classical Kalman filter iteration, the coordinate volatility can be decreased as far as possible and is controlled within a certain accuracy. Once the coordinates seriously run away from effective range, the iteration data is forced to stay within a reasonable range.
In order to reflect that the proposed GIMLE algorithm has better location performance, three localization algorithms which can also run in network blind area are introduced in which Kalman filter improved maximum likelihood estimation algorithm (KIMLE) makes a reasonable improvement of classical MLE algorithm and combines with Kalman filter to realize the localization of blind area. Kalman filter optimizing RSSI ranging and Kalman filter improved maximum likelihood estimation algorithm (KRKIMLE) are based on KIMLE algorithm, plus the process of the Kalman filter optimization of RSSI ranging information, and further improve the positioning accuracy. Kalman filter gridbased improved maximum likelihood estimation algorithm (KGIMLE) is a reasonable complement to GIMLE algorithm and enhances the smoothing effect of the positioning data.

Virtual Beacon Nodes in Network Blind
Area. Due to random deployment of beacon nodes in WSNs, or the environment destructive disasters that destroyed part of beacon nodes, the network blind area comes into being. This paper proposes a virtual beacon node method; the determination of the virtual node coordinates is combined with the improved classical Kalman filter, to ensure the rationality of the algorithm.
When the mobile robot moves to network blind area, as a result of a terrible shortage of the reference beacon nodes, the necessary number of nodes for GIMLE algorithm cannot be met. At this point, the output results of the mathematical model often have dozens of meters of positioning errors, form severe localization deviation, and cause the failure of the whole positioning process. So in the special cases of less than three beacon nodes, with the reference of the optimal coordinate data generated by the improved classical Kalman filter, the enough number of the virtual beacon nodes is produced for GIMLE. Then, the mathematical model of GIMLE algorithm is used to realize localization in absolute network blind area environment. The generation algorithm of virtual nodes is that in which Node is the known beacon node coordinates around the mobile robot; RandStep is the Gaussian white noise, whose mean value is 0 and variance is the square of robot step length. When the estimated distances from the mobile robot to three beacon nodes are known, GIMLE algorithm is initialized. Among the beacon nodes, 1 or 2 can be the virtual node created by Kalman filtering algorithm.
For the absolute network blind spots without any beacon node, this paper also proposes a compensation algorithm and ensures that the algorithm can run smoothly in any network environment. The idea is to make full use of the improved classical Kalman filter to produce optimal coordinates; the virtual positioning coordinates of the mobile robot are randomly generated; then, the coordinates are assumed to be the data of observation equations for the localization algorithm of the mobile robot and imported into the classical Kalman filter in order to be smoothed and optimized.

Simulation Experiment and Result Analysis.
In the indoor environment, the mobile robot is set to complete a sampling every 0.5 s and lasts for 20 seconds. The mobile robot crosses 50 m×50 m WSNs monitoring area with random deployment at a speed of 50 m/s. The range threshold of radio frequency signal is 15 m. When the numbers of beacon nodes are different in random deployment, Figure 6 analyzes the statistical information of beacon node number dynamically detected by the mobile robot. In the area of 16 nodes deployed, the robot detects two beacon nodes at four sampling times, detects three beacon nodes at 13 sampling times, and detects more than four beacon nodes at 24 sampling times. With reduction of the node density, the robot has more sampling times to detect network blind area with fewer than three beacon nodes. For example, in the 14-node area, there are four sampling times to detect a beacon node and five sampling times to detect two beacon nodes. In the 12-node area, two beacon nodes are detected up to 26 times. In the 8-node area, 0 beacon nodes are detected at 16 times, a beacon node is detected at 11 times, two beacon nodes are detected at 16 times, and there are no three beacon nodes cases.
In the WSNs localization algorithm, MLE algorithm with better localization accuracy and stronger environment adaptability becomes an important standard of advantages and disadvantages of various localization algorithms. However, MLE algorithm has strict requirement of beacon node number in the surrounding environment; it cannot be less than three beacon nodes. Otherwise, MLE algorithm will fail due to insufficient data. In this paper, the research area of WSNs environment is scarcity of beacon nodes in all experimental environments; network blind area with less than three beacon nodes appears at different degrees. Therefore, this paper treats KIMLE algorithm with stronger robustness as the main measurement to evaluate the other algorithms. The other algorithms are compared with KIMLE algorithm and draw the relevant conclusions of the localization performance. Figure 7 compares RMSE estimate errors of various kinds of Kalman filtering algorithms in different network blind areas. In the 16-node area, node density is higher; the network blind area is limited to two beacon nodes. The proposed KIMLE algorithm can still run properly, providing a better positioning accuracy. The estimated errors of KIMLE algorithm are slightly higher, but KRKIMLE algorithm is close to optimal estimation. The errors of KGIMLE algorithm are higher. With the further reduction of the node density,  the errors of KIMLE algorithm are increasing. When there is an absolute network blind area with 0 beacon nodes, the errors of KRKIMLE algorithm are significantly higher than those of that without distance optimization. The reason is that in the mechanism of Kalman filtering algorithm, the estimated distance of the virtual node is not from the measured data and cannot be effectively smoothed and optimized. With the decrease of the detected beacon node number, the probability density mathematical model of GIMLE algorithm is failing. Although it still can continually output position estimation, the error has been far from the actual location.   KGIMLE algorithm comes into the best condition; however, it becomes the most accurate Kalman filtering algorithm among others.
KIMLE and KRKIMLE are proposed methods in the published paper [14]. Since the algorithms are also verified in a similar scenario, network blind spots, it is reasonable to compare the proposed algorithms with them.
In the area of 8 beacon nodes randomly deployed, Figure 8 describes the scenario that the mobile robot moves through the absolute network blind area and takes sampling information. When the robot starts, only one beacon node can be detected, then enters the absolute network blind spots, and gradually establishes information communication with 2 beacon nodes. In this period, there are 11 sampling times without any beacon node information detected. Only a beacon node's information is detected at 15 sampling times; two beacon nodes are detected up to 15 times. The whole process does not meet the requirement of the normal localization algorithm which needs at least three beacon nodes' information. Figure 9 is expounded in the error cumulative distribution of the Kalman filtering algorithm in the absolute network blind area. The figure shows that KGIMLE algorithm provides relatively accurate location information with the help of virtual node information. KIMLE algorithm can also be close to the optimal location estimation. Only the errors of KRKIMLE algorithm are bigger. Figure 10 compares the positioning errors of the Kalman filtering algorithms in the absolute network blind area. All the algorithms after Kalman filtering can keep the smoothing estimation information of the localization and have almost no obvious fluctuation. Furthermore, the initial stage can provide a better location performance. However, with the increase of cumulative error, the gap between algorithms begins to widen. KRKIMLE algorithm has the largest errors. The rest of the algorithms can control the errors in small range. Through the absolute network blind area, KGIMLE algorithm works best. Figure 11 describes the role of virtual beacon node to significantly reduce positioning errors in the absolute network blind area. Because of the constraint of the MLE mathematical model, when the number of beacon nodes is less than three, the localization algorithm will not be able to start. The mathematical model must use virtual beacon nodes to reach the minimum requirement. Therefore, in the absolute network blind area environment discussed in this paper, the algorithms need to rely on the virtual beacon nodes to complete localization. This paper only discusses the error comparison between GIMLE and KGIMLE algorithms which can fulfill the localization in absolute network blind area. With the aid of virtual beacon node information, KGIMLE algorithm can keep positioning error smooth and manageable. Because of beacon nodes scarcity, GIMLE algorithm produces obvious position estimation errors, fluctuates in a big range, and cannot effectively localize.

Self-Localization Experiment in Grid-Based Deployment.
The experimental environment is the 1020 cm × 630 cm laboratory room. Indoor personnel are many; tables and chairs are positioned around the walls; instrument and wireless equipment are relatively abundant; the superposition and interaction effect of various signals is obvious. Considering the actual application situation, CC2530 beacon nodes are hanging on the grid area of the ceiling in advance. The particular location of the ground, which will be reached by the self-localization node, has been marked. In order to avoid the serious effect of the ground reflection, CC2530 selflocalization node selects the high level of 50 cm from the ground to collect measurement data. The vertical distance between self-localization node and beacon node is 112 cm.
International Journal of Distributed Sensor Networks  CC2530 self-localization node collects the receiving signal strength information from beacon nodes at each scheduled sample point. The measurements of the same beacon node are averaged, in order to keep the unique data of each beacon node. Then, all the data are imported to the computing device to complete the position estimation.
(1) Four Beacon Nodes' Localization Experiment. In practice, the room usually deploys 4 beacon nodes. This experiment designs the scenario of 4 beacon nodes deployed with grid topology, as shown in Figure 12. Figure 13 describes the error cumulative distribution of Kalman filtering algorithm in the scene of 4 beacon nodes. Due to obtaining enough location information of beacon nodes by MLE algorithm, the localization effect is good. The proposed KGIMLE algorithm also shows good positioning effect; the trend of the error cumulative distribution is almost exactly the same as MLE algorithm.  (2) Localization Experiment with 3 Beacon Nodes. With the application environment of sparse beacon nodes, this experiment designs the scenario of 3 beacon nodes deployed with grid topology. Figure 15 shows the positioning performance of KGIMLE algorithm. Figure 16 expounds the trend of error cumulative distribution of each algorithm in the scene of 3 beacon nodes. Although, compared with KIMLE algorithm, the errors of KGIMLE algorithm increase slightly, it is far better than the trend of error cumulative distribution of KRKIMLE algorithm. Figure   (3) Localization Experiment with 2 Beacon Nodes. According to the network blind area in the disaster relief system, with the failure of a large number of beacon nodes caused by the high intensity damage factors, this experiment designs a special scenario with 2 beacon nodes deployed with grid topology. Figure 18 shows the positioning effect of KGIMLE algorithm. the virtual node produced by the Kalman filter, KGIMLE algorithm has good performance of the localization accuracy. In most of the time, it is better than KIMLE and KRKIMLE algorithms. Figure 20 compares the position error of the Kalman filtering algorithms in each sample point. KGIMLE algorithm achieves the best positioning accuracy in almost all sampling points. It meets the design requirement in this paper.

Localization Experiment of Mobile Robot Based on Grid
Deployment. The experimental environment is absolutely the same as the self-localization experimental environment. In indoor beacon node deployment as shown in Figure 21(a), the number of people is many, and activities completely the same as the desired trajectory. Furthermore, the robot's movement speed is affected by factors such as turning and escapes and cannot be constant. Colligating the above constraints, therefore, the actual localization algorithm is designed. From the time of receiving the first signal strength information, every 5-signal strength data into a set, as a sampling point of the positioning algorithm, calculates the range measurement data. The final set of data can increase the range measurement data according to actual circumstances. Each group of data is classified according to different beacon nodes. The signal strength information of the same beacon node calculates mean value. The redundant information of data fusion is implemented.

(1) Localization Experiment of Mobile Robot in 4 Beacon
Nodes' Environment. Under the condition of 4 beacon nodes deployed with grid topology in the room, the beacon node number, which is dynamically detected by the robot, is shown in Figure 22(a). Due to the influence of complex noise environment in the room, the majority of the sampling points detect only three beacon nodes. However, it fully meets the localization requirement of MLE algorithm. Therefore, three algorithms all show good positioning effect. The actual positioning effect is shown in Figures 22(b)-22(d). detected by mobile robot is reduced significantly; a large number of network blind area phenomena appear, as shown in Figure 23(a). Because the Kalman filter algorithm provides the virtual nodes and positioning optimization, three positioning algorithms complete the localization estimation very well. In particular, the path estimation of KGIMLE algorithm is smooth and accurate, as shown in Figure 23(d).

(3) Localization Experiment of Mobile Robot in 2 Beacon
Nodes' Environment. In the special scenario of two beacon nodes deployed with grid topology, KRKIMLE algorithm is the only one to have a bigger estimated position deviation. Other localization algorithms perform well. Among them, KGIMLE algorithm is excellent to fulfill the localization estimation; the estimated and scheduled path overlap completely; it reaches the design requirements, as shown in Figure 24(d).

Conclusion
This paper addresses the complex indoor WSNs environment, especially focusing on the solution of the network blind area, which is produced in the process of the random deployment of beacon nodes. A class of Kalman filtering algorithm which is suitable for the network blind area is redesigned here. Through the repeated and extensive experiments, the positioning method shows the low cost, robustness, and simple implementation and can be extended for disaster relief system of the real environment.