Library to implement a particle filter using sonar data as measurement