Add untested version of A* algorithm
3 files changed