Robust RBPF-SLAM for Indoor Mobile Robots Using Sonar Sensors in Non-Static Environments

摘要

We propose a robust simultaneous localization and mapping (SLAM) with a Rao-Blackwellized particle filter (RBPF) algorithm for mobile robots using sonar sensors in non-static environments. The algorithm consists of three parts: sampling from multiple ancestor sets, estimating intermediate paths for map updates and eliminating spurious landmarks using negative information from sonar sensors. The proposed sampling method, in which particles are sampled from multiple ancestor sets, increases the robustness of the estimation of the robot's pose, even if environmental changes corrupt observations. This step increases the probability of some particles being sampled from correct ancestor sets that are updated by observations reflected from stationary objects. When particles are sampled from several time steps earlier, however, observations at intermediate time steps cannot be used to update the map because of the lack of information about the intermediate path. To update the map with all sensor information, the intermediate path is estimated after particles are sampled from ancestor sets. Finally, spurious landmarks still exist on the map representing objects that were eliminated or that were extracted by error in cluttered areas. These are eliminated in the final step using negative information from the sonar sensors. The performance of the proposed SLAM algorithm was verified through simulations and experiments in various non-static environments.