Initial heap implementation
Test that updating works.
Move heap to a header