Add binary heap data structure and test files