fix grasp path planning(set env)
Merge pull request #250 from irvs/issue200

fix grasp path planning(set env)