Implemented insert algorithm
Use new insert() function for inserting into tree