grasping with one planning
 divide into libs
dividing into libs done
bug for grasping with both grippers
grasp point added
robot unfolding & calibration xtion fixed
robot unfolding & calibration xtion fixed