Full particle filter

The particle filter is there. now we simply need to tweak it:
1) Appropriate noise level/variance
2) Appropriate damping factor
3) Shifts in x,y and theta when resampling
4) The amount of movement the robot makes

Also need to implement multiple scans per position