added addNode method, it compile and looks working from my test.cpp code. Now we need methods for searching in the tree, like searchIDinTree and searchNearestNeighbor