Completed binary heap code (1st draft)

Signed-off-by: Nigel <Nigel@10.202.5.30>