Finshed AI algorithms
Finished movement algorithms