heap: add insert/upheap; start unit test for this