Fixed null pointer exception when there is no possible path
Added HeapUtils class with extensions methods for heap operations on generic List<T> objects