A simple A* pathfinding implemented in Java