Added new test print method
Fixed lots of errors
Implemented small tree test