fix swarm resampling bug, more debug output, lower particle count, split out filtering function, initialize filter before moving
fix normally distributed number generation, clean up debugging files, simplify resampling code, open/close hokuyo every time