Update include/kheap.h

Adding heap implementation from JamesM's tutorial