Pathfinding done but not implemented in game