modify grasp function for actual machine test
Merge pull request #253 from irvs/issue241

modify grasp function for actual machine test