Finished Debug Particle Filtering