Remove print functions
Write small bin-heap test