add hierarchy.hpp/.cpp and node.hpp/.cpp; have not finished path-finding