Reworking pathfinding
Working A* pathfinding