Starting to implement binary heap in solution_1.cpp