Started correcting the implementation of the A* algorithm. The set class needs to be redone.