initial version of AStar algorithm
priority queue implementation
change_priority method in PriorityQueue
fixed AStar
AStar simple specification