Heap Lab Pull Request

Still doesn't pass seconde test in main method and can't figure out the bug at the moment.