Fixed bug with computing direction between units. Finished the
equi-distant swarm AI model which can be loaded into the simulation