Recursive Bayesian initialization of localization based on ranging and dead reckoning

The initialization of the state estimation in a localization scenario based on ranging and dead reckoning is studied. Specifically, we treat a cooperative localization setup and consider the problem of recursively arriving at a unimodal state estimate with sufficiently low covariance such that covariance based filters can be used to estimate an agent's state subsequently. The initialization of the position of an anchor node will be a special case of this. A number of simplifications/assumptions are made such that the estimation problem can be seen as that of estimating the initial agent state given a deterministic surrounding and dead reckoning. This problem is solved by means of a particle filter and it is described how continual states and covariance estimates are derived from the solution. Finally, simulations are used to illustrate the characteristics of the method and experimental data are briefly presented.

[1]  Stergios I. Roumeliotis,et al.  On the treatment of relative-pose measurements for mobile robot localization , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[2]  Moe Z. Win,et al.  Information Coupling in Cooperative Localization , 2011, IEEE Communications Letters.

[3]  John J. Leonard,et al.  Cooperative Localization for Autonomous Underwater Vehicles , 2009, Int. J. Robotics Res..

[4]  John J. Leonard,et al.  Cooperative Localization for Autonomous Underwater Vehicles , 2009, Int. J. Robotics Res..

[5]  Stergios I. Roumeliotis,et al.  Asynchronous Multi-Centralized Cooperative Localization , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Gaurav S. Sukhatme,et al.  Putting the 'I' in 'team': an ego-centric approach to cooperative localization , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[7]  Javier González,et al.  A pure probabilistic approach to range-only SLAM , 2008, 2008 IEEE International Conference on Robotics and Automation.

[8]  Moe Z. Win,et al.  Cooperative Localization in Wireless Networks , 2009, Proceedings of the IEEE.

[9]  Isaac Skog,et al.  Cooperative localization by dual foot-mounted inertial sensors and inter-agent ranging , 2013, EURASIP J. Adv. Signal Process..

[10]  John-Olof Nilsson,et al.  Analytical argument likelihood function for a noncentral bivariate symmetric Gaussian distribution , 2013 .

[11]  Stergios I. Roumeliotis,et al.  3D relative pose estimation from distance-only measurements , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Edwin Olson,et al.  On computing the average orientation of vectors and lines , 2011, 2011 IEEE International Conference on Robotics and Automation.

[13]  Stergios I. Roumeliotis,et al.  Robot-to-Robot Relative Pose Estimation From Range Measurements , 2008, IEEE Transactions on Robotics.

[14]  Nikolas Trawny.  Cooperative Localization: On motion-induced initialization and joint state estimation under communication constraints. , 2010 .