Add checkHeap() method that verifies whether or not the heap property is
maintained.
Add use of checkHeap() method in test.cpp