Improved HashSet version of A*, 50% faster.