Particle Filter Commit 2

- Enhancing framework for multiple feature handling
- adding several functions