Updated MC localisation update step

Points are now scattered among mesh points, instead of randomly through the space. Also, when at an interest point, the points have a probability of not moving at all.