Added AStar class and fixed a few small things.