particle filter working
mean reinitialization works