Added swarm-movement and swarm best position

Created function for moving every particle in a swarm and updating the swarms best know position
Updated to resemble the current code
More work with velocity

Trying to make use of the velocity, but going slow
Updated core and foa to reflect new code