diff --git a/jsk_arc2017_baxter/euslisp/lib/pick-interface.l b/jsk_arc2017_baxter/euslisp/lib/pick-interface.l index b2aedc476..2c9991851 100644 --- a/jsk_arc2017_baxter/euslisp/lib/pick-interface.l +++ b/jsk_arc2017_baxter/euslisp/lib/pick-interface.l @@ -475,8 +475,7 @@ (when moveit-p- (send self :add-cardboard-scene target-cardboard-)))))) (:return-from-place-object (arm) (let (avs) - (setq avs (list (send *baxter* :avoid-shelf-pose arm (if (eq arm :larm) :d :f)))) - (pushback (send *baxter* :arc-reset-pose arm) avs) + (setq avs (list (send *baxter* :arc-reset-pose arm))) (send *ri* :angle-vector-sequence avs 5000 (send *ri* :get-arm-controller arm) 0) (send *ri* :wait-interpolation) (if (eq grasp-style- :pinch)