Added HeapRemoveAt function for removing arbitrary items from a heap while maintaining the heap property
First functioning A* implementation