Added a laser model. Cleaned up a bit of code (moved some things out of particle filter into their own classes). Still need to move re-sampling into its own class.