An Improved Probability Density Function for Representing Landmark Positions in Bearing-Only SLAM Systems

To navigate successfully, a mobile robot must be able to estimate the spatial relationships of the objects of interest in its environment accurately. The main advantage of a bearing-only Simultaneous Localization and Mapping (SLAM) system is that it requires only a cheap vision sensor to enable a mobile robot to gain knowledge of its environment and navigate. In this paper, we focus on the representation of the spatial uncertainty of landmarks caused by sensor noise. We follow a principled approach for computing the Probability Density Functions (PDFs) of landmark positions when an initial observation is made. We characterize the PDF p(r, α) of a landmark position expressed in polar coordinates when r and α are independent, and the marginal probability p(r) of the PDF is constrained to be uniform.

[1]  James J. Little,et al.  Vision-based SLAM using the Rao-Blackwellised Particle Filter , 2005 .

[2]  Wolfram Burgard,et al.  Monte Carlo Localization: Efficient Position Estimation for Mobile Robots , 1999, AAAI/IAAI.

[3]  Tim Bailey Constrained initialisation for bearing-only SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[4]  Michel Devy,et al.  Undelayed initialization in bearing only SLAM , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Howie Choset,et al.  Bearing-only landmark initialization with unknown data association , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[6]  Frederic Maire,et al.  Uncertainty analysis of a landmark initialization method for simultaneous localization and mapping , 2005 .

[7]  Tucker Balch,et al.  Merging Probabilistic Observations for Mobile Distributed Sensing , 2000 .

[8]  Henrik I. Christensen,et al.  Simultaneous localization and mapping in domestic environments , 2001, Conference Documentation International Conference on Multisensor Fusion and Integration for Intelligent Systems. MFI 2001 (Cat. No.01TH8590).

[9]  Sebastian Thrun,et al.  FastSLAM 2.0: an improved particle filtering algorithm for simultaneous localization and mapping that provably converges , 2003, IJCAI 2003.

[10]  Gamini Dissanayake,et al.  An efficient multiple hypothesis filter for bearing-only SLAM , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[11]  D. Spero Simultaneous Localisation and Map Building: The Kidnapped Way , 2021 .

[12]  Andrew J. Davison,et al.  Real-time simultaneous localisation and mapping with a single camera , 2003, Proceedings Ninth IEEE International Conference on Computer Vision.

[13]  Yolanda González Cid,et al.  Real-time 3d SLAM with wide-angle vision , 2004 .

[14]  Emanuele Menegatti,et al.  Image-based Monte Carlo localisation with omnidirectional images , 2004, Robotics Auton. Syst..