Finished First approximation of particle Filter using CPU