Successful particle filter

And results