The Scientific World Journal

Volume 2014 (2014), Article ID 138548, 7 pages

http://dx.doi.org/10.1155/2014/138548

Research Article

Adaptive Iterated Extended Kalman Filter and Its Application to Autonomous Integrated Navigation for Indoor Robot

Yuan Xu,1,2 Xiyuan Chen,1,2 and Qinghua Li1,3

¹School of Instrument Science and Engineering, Southeast University, Nanjing, China

²Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Nanjing, China

³School of Electrical Engineering and Automation, Qilu University of Technology, Jinan, China

Received 24 October 2013; Accepted 30 December 2013; Published 13 February 2014

Academic Editors: S. Balochian, V. Bhatnagar, and Y. Zhang

Copyright © 2014 Yuan Xu 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.

Abstract.

As the core of the integrated navigation system, the data fusion algorithm should be designed seriously. In order to improve the accuracy of data fusion, this work proposed an adaptive iterated extended Kalman (AIEKF) which used the noise statistics estimator in the iterated extended Kalman (IEKF), and then AIEKF is used to deal with the nonlinear problem in the inertial navigation systems (INS)/wireless sensors networks (WSNs)-integrated navigation system. Practical test has been done to evaluate the performance of the proposed method. The results show that the proposed method is effective to reduce the mean root-mean-square error (RMSE) of position by about 92.53%, 67.93%, 55.97%, and 30.09% compared with the INS only, WSN, EKF, and IEKF.

1. Introduction

As the development of automation indoor mobile robots, how to obtain accurate navigation information of indoor mobile robots has received great attention over the past few decades.

To the integrated system, the global positioning systems (GPS)/inertial navigation systems (INS) integrated system is one of the most used methods for the outdoor navigation. Many attempts try to improve the accuracy of the GPS/INS integration. For example, Quinchia et al. compared different error modeling of MEMS applied to GPS/INS integrated systems in [1], Jwo et al. proposed a fuzzy adaptive strong tracking unscented Kalman filter for ultratight GPS/INS integrated systems [2], Chen et al. proposed a GPS/INS system using novel filtering methods for vessel attitude determination [3], and Jwo et al. proposed a nonlinear filtering with IMM algorithm for ultratight GPS/INS integration [4]. Meanwhile, in order to overcome the GPS outage, some attempts try to design bridge methods by using the artificial intelligence algorithms [5] such as Neural Networks (NN) [6–8] and least squares support vector machine (LS-SVM) [9–11]. However, since the accuracy of the integrated system is depending on the GPS, it has poor performance in the indoor environment. In order to get higher positioning accuracy indoor, some literatures try to employ wireless localization to replace the GPS in the integrated system. For instance, S. J. Kim and B. K. Kim proposed an accurate hybrid global self-localization algorithm for indoor mobile robots with two-dimensional isotropic ultrasonic receivers [12], and an accurate pedestrian indoor navigation by tightly coupling foot-mounted IMU and RFID measurements was proposed in [13]. On the basis of the navigation strategy, the data fusion algorithm should also be designed seriously. In this field, Kalman filter (KF) is able to achieve the optimal state estimation [14]. However, it is not suitable for nonlinear systems. Thus, the extended KF (EKF) is proposed to overcome this problem by Taylor series expansion, which may introduce a truncated error [15]. In order to overcome this problem, the iterated EKF (IEKF) is proposed. However, the data fusion algorithms mentioned above are difficult to track the accurate state during the target’s fast movement since it employs a fixed priori estimates for the process and measurement noise covariances during the whole estimation process [16].

In order to overcome these problems, we employed the noise statistics estimator in the IEKF, which combines the advantages of the AEKF and the IEKF. The remainder of the paper is organized as follows. Sections 2 and 3 give the introduction for AIEKF and its application to INS/WSN integrated system. The tests and discussion are illustrated in Section 4. Finally, the conclusions are given.

2. Adaptive Iterated Extended Kalman Filter

In this section, a brief introduction to the EKF and IEKF will be given, and then AIEKF will be proposed. It is assumed that a discrete-time model of a nonlinear system is given by

where and are the state vector and the measurement vector for the filter, and are the dynamic model function and the measurement function, respectively, and and are the process noise vector and measurement noise vector, respectively. It is assumed that and are independent zero-mean white Gaussian sequences with covariance and , respectively.

2.1. Extended Kalman Filter

The traditional EKF algorithm is utilizing a set of equations as follows [17]:

where, .

2.2. Iterated Extended Kalman Filter

Compared with the EKF, the IEKF employs a few simple iterative operations to reduce the bias and the estimation error after gettingin (2) andin (3). The corresponding recursive relations are

where and the superscript   is the number of iteration steps, And then,

2.3. Adaptive Iterated Extended Kalman Filter

The EKF overcomes the nonlinear problem by ignoring the higher order terms, which may introduce a truncated error. Thus, the IEKF overcomes this problem. However, it is evident that both theandfor EKF and those for IEKF are prior estimates. In practice, there are uncertainties in the noise description, and the assumptions on the statistics of disturbances are violated since the availability of precisely known model is unrealistic practical situations. In order to overcome these problems, we employed the noise statistics estimator into the IEKF. Meanwhile, when the system noise is stable and the error variance is small, it is able to employ observation noise estimator only. The corresponding recursive relations are

whereis computed by the time-varying noise statistics estimators with the following equations:

here,, . And then,

3. Adaptive Iterated Extended Kalman Filter for Integrated Navigation

In this work, we just consider the navigation information for mobile robot in the relative coordinate. The INS error is the accumulation of errors in each time. In order to achieve better estimation accuracy of INS error, the state vector is defined by . Here, , ,   and are the errors of position, velocity, and accelerometer measured by INS in east and north direction. The system equation for the filter at time is illustrated in.

where is sample time and is the process noise vector. The measurement equation for the filter at time is illustrated in.

Here, is the difference between the distance form reference node (RN) to the mobile robot measured by the INS and WSN, respectively, at time , and it is expressed as follows:

where and are the distances from mobile robot to th RN measured by the INS and WSN, respectively, is INS position for mobile robot, and is th RN position. And is the difference of the WSN and INS velocities in east and north direction, respectively, and is measurement noise vector. The derivation of (15) has a very detailed description in [18]. The configuration of the hybrid system is shown in Figure 1.

Figure 1: Configuration of the hybrid system.

4. Indoor Localization Tests and Discussion

4.1. The Architecture of the Integrated Navigation System

In this work, a real testbed is built to evaluate the performance of the proposed method. Figure 2 displays the architecture of the testbed. In this work, the mobile robot (shown in Figure 3) is used to run along the preset trajectory. The IMU fixed to the robot are used to provide INS solution for the position, velocity, and the attitude of the mobile robot. The mobile robot position measured by the WSN is used as ultrasonic sender and the receiver. And the computer is used for saving sensor data.

Figure 2: The architecture of the integrated navigation system.

Figure 3: The prototype of the robot.

The sample time used in the test is 0.02 s, and the mobile robot runs along the trajectories shown in Figure 4 with 0.3 m/s. Meanwhile, the RNs are denoted by yellow circles in Figure 4.

(a)

(b)

Figure 4: The trajectory of the real test.

4.2. The Performance of the Proposed Method

In this section, the performance of the proposed method is discussed. The position errors for the INS only, WSN, EKF, IEKF, and the proposed method are shown in Figure 5.

(a)

(b)

(c)

(d)

Figure 5: The position errors for the INS only, WSN, EKF, IEKF, and the proposed method. (a) and (b) The first trajectory. (c) and (d) The second trajectory.

The east and north position errors of five estimation strategies in the first trajectory are shown in Figures 5(a) and 5(b), respectively. From these figures, it can be seen easily that the INS position error is accumulated. WSN is able to maintain the accuracy of position. It is evident that both the EKF and the IEKF are effective in reducing the position error compared with WSN. The errors for the proposed method are smaller than the ones for the IEKF. Figures 5(c) and 5(d) display the east and north position errors of five estimation strategies in the second trajectory. Similar to the first trajectory, it is evident that the proposed method has the smallest error.

The comparison of five estimation strategies in terms of position error is shown in Table 1. The results show that the proposed method has the lowest error in east and north direction respectively. The mean root-mean-square error (RMSE) of position for the proposed method is 0.0295 m. It reduces the mean RMSE of position by about 92.53%, 67.93%, 55.97%, and 30.09% compared with the INS only, WSN, EKF, and IEKF.

Table 1: Comparison of five estimation strategies in terms of position error.

Method
RMSE (m)

The first trajectory
The second trajectory
Mean

East
North
East
North

INS only
0.5912
0.4590
0.2108
0.3179
0.3947

WSN
0.1132
0.0787
0.1065
0.0697
0.0920

EKF
0.0721
0.0639
0.0736
0.0582
0.0670

IEKF
0.0433
0.0433
0.0462
0.0360
0.0422

The proposed method
0.0333
0.0290
0.0309
0.0249
0.0295

Table 2 shows the comparison of five estimation strategies in terms of velocity error. It can be seen that the EKF, IEKF, and the proposed method are able to reduce the velocity error compared with the IN S and the WSN, respectively. The result shows that the mean RMSE of velocity for the proposed method is 0.0468 m/s. However, the velocity estimation accuracy for the EKF, IEKF, and the proposed method is close.

Table 2: Comparison of five estimation strategies in terms of velocity error.

Method
RMSE (m/s)

The first trajectory
The second trajectory
Mean

East
North
East
North

INS only
0.1391
0.1682
0.1400
0.0957
0.1358

WSN
0.0595
0.0854
0.0650
0.0794
0.0723

EKF
0.0441
0.0539
0.0424
0.0437
0.0460

IEKF
0.0425
0.0556
0.0412
0.0482
0.0469

The proposed method
0.0445
0.0546
0.0420
0.0462
0.0468

5. Conclusions

In this work, the noise statistics estimator is employed into the IEKF to combine the advantages of the AEKF and the IEKF. Then, the AIEKF is used in INS/WSN integrated system. The experimental results show that the proposed method is effective in reducing the position error compared with the INS only, WSN, EKF, and IEKF; however, the velocity estimation accuracy for the EKF, IEKF, and the proposed method is close.

Conflict of Interests

The authors of the paper do not have a direct financial relation that might lead to a conflict of interests for any of the authors.

Acknowledgments

This work was supported in part by the National Natural Science Foundation of China (nos. 51375087, 41204025, and 50975049), Ocean Special Funds for Scientific Research on Public Causes (no. 201205035-09), Specialized Research Fund for the Doctoral Program of Higher Education (no. 20110092110039), the 52 and China Postdoctoral Science Foundation (no. 2012M520967), and the Program Sponsored for Scientific Innovation Research of College Graduate in Jiangsu Province, China (no. CXLX_0101).

References

A. G. Quinchia, G. Falco, E. Falletti, F. Dovis, and C. Ferrer, “A comparison between different error modeling of MEMS applied to GPS/INS integrated systems,” Sensors, vol. 13, no. 8, pp. 9549–9588, 2013.

D.-J. Jwo, C.-F. Yang, C.-H. Chuang, and C. H. Lee, “Performance enhancement for ultra-tight GPS/INS integration using a fuzzy adaptive strong tracking unscented Kalman filter,” Nonlinear Dynamics, vol. 73, no. 1-2, pp. 377–395, 2013.

X. Chen, C. Shen, and Y. Zhao, “Study on GPS/INS system using novel filtering methods for vessel attitude determination,” Mathematical Problems in Engineering, vol. 2013, Article ID 678943, 8 pages, 2013.

D. J. Jwo, C. W. Hu, and C. H. Tseng, “Nonlinear filtering with IMM algorithm for ultra-tight GPS/INS integration: regular paper,” International Journal of Advanced Robotic Systems, vol. 10, article 222, 2013.

Y. Zhang, P. Agarwal, V. Bhatnaga, S. Balochian, and J. Yan, “Swarm intelligence and its applications,” The Scientific World Journal, vol. 2013, Article ID 528069, 3 pages, 2013.

C. M. Bishop, Neural Networks For Pattern Recognition, Oxford University Press, New York, NY, USA, 1995.

S. Haykin, Neural Networks—A Comprehensive Foundation, IEEE Press, New York, NY, USA, 1994.

A. Noureldin, A. El-Shafie, and M. Bayoumi, “GPS/INS integration utilizing dynamic neural networks for vehicular navigation,” Information Fusion, vol. 12, no. 1, pp. 48–57, 2011.

Z.-K. Xu, Y. Li, C. Rizos, and X. Xu, “Novel hybrid of LS-SVM and kalman filter for GPS/INS integration,” Journal of Navigation, vol. 63, no. 2, pp. 289–299, 2010.

Y. Zhang and L. Wu, “Classification of fruits using computer vision and a multiclass support vector machine,” Sensors, vol. 2012, no. 9, pp. 12489–12505, 2012.

Y. Zhang, S. Wang, G. Ji, and Z. Dong, “An MR brain images classifier system via particle swarm optimization and kernel support vector machine,” The Scientific World Journal, vol. 2013, Article ID 130134, 9 pages, 2013.

S. J. Kim and B. K. Kim, “Accurate hybrid global self-localization algorithm for indoor mobile robots with two-dimensional isotropic ultrasonic receivers,” IEEE Transactions on Instrumentation and Measurement, vol. 60, no. 10, pp. 3391–3404, 2011.

A. R. J. Ruiz, F. S. Granja, J. C. P. Honorato, and J. I. G. Rosas, “Accurate pedestrian indoor navigation by tightly coupling foot-mounted IMU and RFID measurements,” IEEE Transactions on Instrumentation and Measurement, vol. 61, no. 1, pp. 178–189, 2012.

F. Chen and M. W. Dunnigan, “Comparative study of a sliding-mode observer and Kalman filters for full state estimation in an induction machine,” IEE Proceedings: Electric Power Applications, vol. 149, no. 1, pp. 53–64, 2002.

Z. Chen, R. Rodrigo, V. Parsa, and J. Samarabandu, “Using ultrasonic and vision sensors within extended kalman filter for robot navigation,” Canadian Acoustics, vol. 33, no. 3, pp. 28–29, 2005.

H. Shao, D. Kim, and K. You, “TDOA/FDOA geolocation with adaptive extended Kalman filter,” Communications in Computer and Information Science, vol. 121, pp. 226–235, 2010.

A. Gelb, Applied Optimal Estimation, The MIT Press, Cambridge, Mass, USA, 1974.

Y. Xu, X. Y. Chen, and Q. H. Li, “Unbiased tightly-coupled INS/WSN integrated navigation based on extended Kalman filter,” Journal of Chinese Inertial Technology, vol. 20, no. 3, pp. 292–299, 2012.