In order to reduce the estimated errors of the inertial navigation system (INS)/Wireless sensor network (WSN)-integrated navigation for mobile robots indoors, this work proposes an on-line iterated extended Rauch-Tung-Striebel smoothing (IERTSS) utilizing inertial measuring units (IMUs) and an ultrasonic positioning system. In this mode, an iterated Extended Kalman filter (IEKF) is used in forward data processing of the Extended Rauch-Tung-Striebel smoothing (ERTSS) to improve the accuracy of the filtering output for the smoother. Furthermore, in order to achieve the on-line smoothing, IERTSS is embedded into the average filter. For verification, a real indoor test has been done to assess the performance of the proposed method. The results show that the proposed method is effective in reducing the errors compared with the conventional schemes.
References
[1]
Kim, S.J.; Kim, B.K. Accurate hybrid global self-localization algorithm for indoor mobile robots with two-dimensional isotropic ultrasonic receivers. IEEE Trans. Instrum. Meas. 2011, 10, 3391–3404.
Zhang, J.; Song, G.-M.; Qiao, G.-F.; Meng, T.-H.; Sun, H.-T. An indoor security system with a jumping robot as the surveillance terminal. IEEE Trans. Consum. Electron. 2011, 4, 1774–1781.
[4]
Ruiz, A.R.J.; Granja, F.S.; Honorato, J.C.P.; Rosas, J.I.G. Accurate pedestrian indoor navigation by tightly coupling foot-mounted IMU and RFID measurements. IEEE Trans. Instrum. Meas. 2012, 1, 178–189.
[5]
Shirehjini, A.A.N.; Yassine, A.; Shirmohammadi, S. An RFID-based position and orientation measurement system for mobile objects in Intelligent Environments. IEEE Trans. Instrum. Meas. 2012, 6, 1664–1675.
[6]
Park, W.-C.; Yoon, M.-H. The Implementation of Indoor Location System to Control ZigBee Home Network. Proceedings of the 2006 SICE-ICASE International Joint Conference, Busan, Korea, 18–21 October 2006.
[7]
Minami, M.; Morikawa, H.; Aoyama, T. Design and implementation of a fully distributed ultrasonic positioning system. Electron. Commun. Jpn. Part III Fundam. Electron. Sci. 2007, 6, 17–26.
[8]
Fang, L.; Antsaklis, P.; Montestruque, L.; McMickell, M.; Lemmon, M.; Sun, Y.; Fang, H.; Koutroulis, I.; Haenggi, M.; Xie, M.; et al. Design of a wireless assisted pedestrian dead reckoning system—The NavMote experience. IEEE Trans. Instrum. Meas. 2005, 6, 2342–2358.
[9]
Feng, G.-H.; Wu, W.-Q.; Wang, G.-L. Observability analysis of a matrix Kalman filter-based navigation system using visual/inertial/magnetic sensors. Sensors 2012, 12, 8877–8894.
[10]
Boulade, S.; Frapard, B.; Biard, A. GPS/INS Navigation System for Launchers and Re-Entry Vehicles-Developments and Adaptation to Ariane 5. Proceedings of the 5th ESA International Conference on Spacecraft Guidance, Navigation and Control Systems, Frascati, Italy, 22–25 October 2002.
[11]
Xu, Z.-K.; Li, Y.; Rizos, C.; Xu, X.-S. Novel hybrid of LS-SVM and Kalman Filter for GPS/INS integration. In J. Navig.; 2010; Volume 2, pp. 289–299.
[12]
Evennou, F.; Marx, F. Advanced integration of WiFi and Inertial Navigation Systems for indoor mobile positioning. EURASIP J. Appl. Signal Process 2006, 2006, 1–11.
[13]
Lobo, J.; Lucas, P.; Dias, J.; Traca de Almeida, A. Inertial Navigation System for Mobile Land Vehicles. Proceedings of the IEEE International Symposium on Industrial Electronics ISIE'95, Athens, Greece, 10–14 July 1995.
[14]
El-Sheimy, N.; Schwarz, K.P. Integrating Differential GPS Receivers with an Inertial Navigation System (INS) and CCD Cameras for a Mobile GIS Data Collection System. Proceedings of the International Society for Photogrammetry and Remote Sensing Conference, Ottawa, Canada, 6–10 June 1994.
[15]
Fang, J.-C.; Gong, X.-L. Predictive iterated Kalman filter for INS/GPS integration and its application to SAR motion compensation. IEEE Trans. Instrum. Meas. 2010, 4, 909–915.
[16]
Shademan, A.; Sharifi, F.J. Sensitivity Analysis of EKF and Iterated EKF Pose Estimation for Position-Based Visual Servoing. Proceedings of the IEEE Conference Control Application, Toronto, Canada, 28–31 August 2005.
[17]
Lefebvre, T.; Bruyninckx, H.; Schutter, J.D. Kalman filters for nonlinear systems: A comparison of performance. Int. J. Control 2004, 7, 639–653.
[18]
Chiang, K.-W.; Duong, T.T.; Liao, J.-K.; Lai, Y.-C.; Chang, C.-C.; Cai, J.-M.; Huang, S.-C. On-line smoothing for an integrated navigation system with low-cost MEMS inertial sensors. Sensors 2012, 12, 17372–17389.
[19]
Rauch, H.; Tung, F.; Striebel, C. Maximum likelihood estimates of linear dynamic systems. AIAA J. 1965, 8, 1445–1450.
[20]
Gong, X.-L.; Zang, R.; Fang, J.-C. Application of unscented R-T-S smoothing on INS/GPS integration system post processing for airborne earth observation. In Measurement; 2013; Volume 3, pp. 1074–1083.
[21]
Xu, Y.; Chen, X.-Y.; Li, Q.-H. Unbiased tightly-coupled INS/WSN integrated navigation based on extended Kalman filter. J. Chin. Inert. Technol. 2012, 3, 292–299.
