BST on the verge of working perfectly, known bug with height in progress