Reworked A* to use g-score and h-score. IDA uses f-score. Added comments