Mobile Localization in Non-Line-of-Sight Using Constrained Square-Root Unscented Kalman Filter

Localization and tracking of a mobile node (MN) in non-line-of-sight (NLOS) scenarios, based on time-of-arrival (TOA) measurements, is considered in this paper. We develop a constrained form of a square-root unscented Kalman filter (SRUKF), where the sigma points of the unscented transformation are projected onto the feasible region by solving constrained optimization problems. The feasible region is the intersection of several disks formed by the NLOS measurements. We show how we can reduce the size of the optimization problem and formulate it as a convex quadratically constrained quadratic program, which depends on the Cholesky factor of the a posteriori error covariance matrix of the SRUKF. As a result of these modifications, the proposed constrained SRUKF (CSRUKF) is more efficient and has better numerical stability compared to the constrained unscented Kalman filter (UKF). Through simulations, we also show that the CSRUKF achieves a smaller localization error compared to other techniques and that its performance is robust under different NLOS conditions.

[1]  Hiroyuki Tsuji,et al.  Mobile location estimator with NLOS mitigation using Kalman filtering , 2003, 2003 IEEE Wireless Communications and Networking, 2003. WCNC 2003..

[2]  Bjarne A. Foss,et al.  Applying the unscented Kalman filter for nonlinear state estimation , 2008 .

[3]  Rudolph van der Merwe,et al.  The square-root unscented Kalman filter for state and parameter-estimation , 2001, 2001 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings (Cat. No.01CH37221).

[4]  D.G.M. Cruickshank,et al.  Performance of a TDOA-AOA hybrid mobile location system , 2001 .

[5]  Chin-Der Wann,et al.  Hybrid TDOA/AOA Indoor Positioning and Tracking Using Extended Kalman Filters , 2006, 2006 IEEE 63rd Vehicular Technology Conference.

[6]  Moe Z. Win,et al.  Ultrawide Bandwidth RFID: The Next Generation? , 2010, Proceedings of the IEEE.

[7]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[8]  R. Michael Buehrer,et al.  NLOS Mitigation Using Linear Programming in Ultrawideband Location-Aware Networks , 2007, IEEE Transactions on Vehicular Technology.

[9]  R. M. Buehrer,et al.  Non-line-of-sight identification in ultra-wideband systems based on received signal statistics , 2007 .

[10]  J. Lofberg,et al.  YALMIP : a toolbox for modeling and optimization in MATLAB , 2004, 2004 IEEE International Conference on Robotics and Automation (IEEE Cat. No.04CH37508).

[11]  Y. Jay Guo,et al.  Improved Positioning Algorithms for Nonline-of-Sight Environments , 2008, IEEE Transactions on Vehicular Technology.

[12]  Eryk Dutkiewicz,et al.  Improved Kalman filtering algorithms for mobile tracking in NLOS scenarios , 2012, 2012 IEEE Wireless Communications and Networking Conference (WCNC).

[13]  Ismail Güvenç,et al.  A Survey on TOA Based Wireless Localization and NLOS Mitigation Techniques , 2009, IEEE Communications Surveys & Tutorials.

[14]  Ulrich Hammes,et al.  Robust Tracking and Geolocation for Wireless Networks in NLOS Environments , 2009, IEEE Journal of Selected Topics in Signal Processing.

[15]  Josep Vidal,et al.  Mobile location with bias tracking in non-line-of-sight , 2004, 2004 IEEE International Conference on Acoustics, Speech, and Signal Processing.

[16]  D. Simon,et al.  Kalman filtering with inequality constraints for turbofan engine health estimation , 2006 .

[17]  A.H. Sayed,et al.  Network-based wireless location: challenges faced in developing techniques for accurate wireless location information , 2005, IEEE Signal Processing Magazine.

[18]  Eryk Dutkiewicz,et al.  NLOS Identification and Mitigation for Mobile Tracking , 2013, IEEE Transactions on Aerospace and Electronic Systems.

[19]  R. Michael Buehrer,et al.  Target Tracking in NLOS Environments Using Semidefinite Programming , 2013, MILCOM 2013 - 2013 IEEE Military Communications Conference.

[20]  Anja Klein,et al.  Bayesian Cramer-Rao Bound for Mobile Terminal Tracking in Mixed LOS/NLOS Environments , 2013, IEEE Wireless Communications Letters.

[21]  Cipriano Galindo,et al.  Mobile robot localization based on Ultra-Wide-Band ranging: A particle filter approach , 2009, Robotics Auton. Syst..

[22]  Andreas F. Molisch,et al.  Ultrawideband propagation channels-theory, measurement, and modeling , 2005, IEEE Transactions on Vehicular Technology.

[23]  Jos F. Sturm,et al.  A Matlab toolbox for optimization over symmetric cones , 1999 .

[24]  Lenan Wu,et al.  Mobile Tracking in Mixed Line-of-Sight/Non-Line-of-Sight Conditions: Algorithm and Theoretical Lower Bound , 2012, Wirel. Pers. Commun..

[25]  D. Simon.  Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches , 2006 .

[26]  Bor-Sen Chen,et al.  Mobile Location Estimator in a Rough Wireless Environment Using Extended Kalman-Based IMM and Data Fusion , 2009, IEEE Transactions on Vehicular Technology.

[27]  Kaveh Pahlavan,et al.  Indoor geolocation in the absence of direct path , 2006, IEEE Wireless Communications.

[28]  Moe Z. Win,et al.  NLOS identification and mitigation for localization based on UWB experimental data , 2010, IEEE Journal on Selected Areas in Communications.

[29]  X. Rong Li,et al.  State estimation with nonlinear inequality constraints based on unscented transformation , 2011, 14th International Conference on Information Fusion.

[30]  Ulrich Hammes,et al.  Robust Mobile Terminal Tracking in NLOS Environments Based on Data Association , 2010, IEEE Transactions on Signal Processing.

[31]  L. El Ghaoui,et al.  Convex position estimation in wireless sensor networks , 2001, Proceedings IEEE INFOCOM 2001. Conference on Computer Communications. Twentieth Annual Joint Conference of the IEEE Computer and Communications Society (Cat. No.01CH37213).

[32]  Thomas B. Schon,et al.  Tightly coupled UWB/IMU pose estimation , 2009, 2009 IEEE International Conference on Ultra-Wideband.

[33]  G.B. Giannakis,et al.  Localization via ultra-wideband radios: a look at positioning aspects for future sensor networks , 2005, IEEE Signal Processing Magazine.

[34]  Ulrich Hammes,et al.  Robust MT Tracking Based on M-Estimation and Interacting Multiple Model Algorithm , 2011, IEEE Transactions on Signal Processing.

[35]  B. Denis,et al.  Loosely-coupled IR-UWB handset and ankle-mounted inertial unit for indoor navigation , 2011, 2011 IEEE International Conference on Ultra-Wideband (ICUWB).

[36]  Anja Klein,et al.  Robust mobile terminal tracking in NLOS environments using interacting multiple model algorithm , 2009, 2009 IEEE International Conference on Acoustics, Speech and Signal Processing.

[37]  D. Simon.  Kalman filtering with state constraints: a survey of linear and nonlinear algorithms , 2010 .

[38]  Hisashi Kobayashi,et al.  Analysis of wireless geolocation in a non-line-of-sight environment , 2006, IEEE Transactions on Wireless Communications.

[39]  Ismail Güvenç,et al.  NLOS Identification and Mitigation for UWB Localization Systems , 2007, 2007 IEEE Wireless Communications and Networking Conference.

[40]  Charles R. Johnson,et al.  Matrix analysis , 1985, Statistical Inference for Engineers and Data Scientists.

[41]  Isaac Skog,et al.  Bayesian Estimation With Distance Bounds , 2012, IEEE Signal Processing Letters.

[42]  Stephen P. Boyd,et al.  Convex Optimization , 2004, Algorithms and Theory of Computation Handbook.

[43]  Søren Holdt Jensen,et al.  EURASIP Journal on Applied Signal Processing , 2005 .

[44]  Dan Simon,et al.  Constrained Kalman filtering via density function truncation for turbofan engine health estimation , 2010, Int. J. Syst. Sci..

[45]  Kai-Ten Feng,et al.  An efficient geometry-constrained location estimation algorithm for NLOS environments , 2005, 2005 International Conference on Wireless Networks, Communications and Mobile Computing.

[46]  M.Z. Win,et al.  Monte Carlo localization in dense multipath environments using UWB ranging , 2005, 2005 IEEE International Conference on Ultra-Wideband.

[47]  C. Paige.  Computer solution and perturbation analysis of generalized linear least squares problems , 1979 .