Pathfinding workinggit add . Using A* with Manhattan heuristics. Diagonal moves not working yet :/