Algorithm for Swarming