A* pathfinding project. Java