A simple astar pathfinding implementation in java