added more functionality to particle filter,
added feature map
need to decide how the visual information is coming in.
need to write resampling code,
need to extend particlefilter to evade kidnapping problem.