[jsk_fetch_plug_power_spot] update

jsk-ros-pkg · Nov 1, 2021 · 7450781 · 7450781
1 parent 75de78c
commit 7450781
Showing 1 changed file with 6 additions and 6 deletions.
diff --git a/jsk_fetch_plug_power_spot/euslisp/utils.l b/jsk_fetch_plug_power_spot/euslisp/utils.l
@@ -390,12 +390,12 @@
   (send *fetch* :reset-pose)
   (send *ri* :angle-vector (send *fetch* :reset-pose) 5000)
 
-  ;; approach to spot
-  ;;(if (approach-to-spot)
-  ;;  t
-  ;;  (progn
-  ;;    (ros::ros-error "Failed to approach to spot")
-  ;;    (return-from unplug-power-connector nil)))
+   approach to spot
+  (if (approach-to-spot)
+    t
+    (progn
+      (ros::ros-error "Failed to approach to spot")
+      (return-from unplug-power-connector nil)))
 
   ;; move head to ar marker
   (if (move-head-to-markers)