Particle Filter Commit 4

Normal Particle Filter is now working with features
-HoC
- medD

it doesn't have gridding, occlusion flag (not tested), and grid
confidence...