Local and Global Best in PSO

Hi,

I have a PSO algorithm that runs through a Lambert and while it is doing it, I noticed it calculates the local and global best values wrong.I need the global best to be the minimum out of all Cost functions(Total delta v from lambert) in a swarm at each (it) th iteration and and at the end of the MaxIt, it should give me the minimum out of all the cost values. It somehow does not give me min even from the population. Also the Local best should be the best (min) until the (it)th iteration and somehow even that is calculated wrong. I have attached my code.I really need some help. Thanks in advance.