Add an AVLTree, fix updating of height