Update to use various speed and initial implementation of PSO