Example implementation of a binary heap - useful in A * star searches