fix swarm resampling bug, more debug output, lower particle count, split out filtering function, initialize filter before moving