Fix: Mean of diff is averaged by number of good particles.
ParticleFilter:
　Previous: averaged by number of all particles.
　Now: averaged by number of good paricles.