fix grasp path planning(set env)

in subtask grasp function
 - setEnvironment with object's place id (furniture_id)