pek
Working version of the particle filter.

Everything's alright, just the convergence criteria needs some tweaking.