Implement an untested version of A* pathfinding. Generalized for any space.
Clean up all the guava function things behind a PathFindingStrategy interface.