Abstracted exact and heuristic distance methods into separate functions and changed functions which can return nil to also return a found boolean.
Changed open node logic to use a priority queue improving performance 10x.
Updated comments.