KLD-Sampling: Adaptive Particle Filters