particle filter sort of kind of works with no resampling
added images and test