Particle filter update step working buggily. Also makes a LOT of pdfs