add TestParticleFilter.cc to test the implementation of particle fitler