ParticleFilter update, (model fitting -> not working)