This is still a work in progress; the code should work as intended now, but for the Gaussian case the Particle Filter seems to degenerate relatively often.