Particle filter now returns a single pose