further hubo manip progress
Clean up and organization of Grasper, SimpleHubo