Create HCTree.cpp

Implemented HCTree.cpp, minor changes in HCTree.hpp