added to particle filter and made tests