Minor improvements to PriorityQueue
Adding nodegraph
Revised A* to handle any formation of nodes
Updating README
Updating README with correct package
Minor cleanup
Merge branch 'master' into steer