Implemented basic A* to find minimal makespan path to goal state