mostly finished roboTree and wrote tests