PSO working, but code to correction

PSO working, but not as good as it should