finished rgbd tree + rgbd line detection pre final