Adding aStar pathing algorithm