Finished heap algorithms. Added heap unit tests.