Initialization of particles added
Added a gaussian function and laser scan dummy code
Forgot to commit mathutil