Enabled integration in particle filter. Working pretty well.