Add unit test using gtest for binary heap