imaplemented first draft of particle filter