Added first particle filter. Trivial case kind of works.