Added HeapUtils.MakeHeap
Added HeapAdd and HeapRemove extension methods
Added a PriorityQueue class
Added extension methods for GridCoordinate in GridCoordinateUtils
Pushed simple queue-based OpenList down from PathFinder into BreadthFirstSearch