Made the particle filter and simulator actually work. Also fixed a bug in the stereo postprocessing node