Refactored baxter_pick_place
Fixed gripper closing issue