Adding particle filter code initial commit