using PriorityQueue as open list
Nodes orderd by Comparable interface