diff --git a/jsk_2016_01_baxter_apc/euslisp/in-hand-data-collection-main.l b/jsk_2016_01_baxter_apc/euslisp/in-hand-data-collection-main.l index 3c74ef8d9..5e0ec7a06 100755 --- a/jsk_2016_01_baxter_apc/euslisp/in-hand-data-collection-main.l +++ b/jsk_2016_01_baxter_apc/euslisp/in-hand-data-collection-main.l @@ -256,6 +256,10 @@ (send self :view-hand-pose :pos :i) ) (send self :set-param-hand-pose) + (if (send *ri* :graspingp arm_) + (ros::set-param "~object_label" (elt object-list_ object-id_)) + (ros::set-param "~object_label" "no_object") + ) (send self :send-save-request) ;; View hand randomly (optimally in future) ;; TODO(wkentaro): view hand optimally here with ML @@ -264,6 +268,10 @@ (send self :view-hand-pose) (send self :set-param-hand-pose) ;; Send saving request + (if (send *ri* :graspingp arm_) + (ros::set-param "~object_label" (elt object-list_ object-id_)) + (ros::set-param "~object_label" "no_object") + ) (send self :send-save-request) ) (while