Add method copy process for robot arm part

jsk-enshu · Sep 19, 2018 · f696fdb · f696fdb
1 parent 5caec8b
commit f696fdb
Show file tree

Hide file tree

Showing 2 changed files with 9 additions and 5 deletions.
diff --git a/dxl_armed_turtlebot/euslisp/dxl-armed-turtlebot-interface.l b/dxl_armed_turtlebot/euslisp/dxl-armed-turtlebot-interface.l
@@ -14,7 +14,7 @@
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 (defclass dxl-armed-turtlebot-interface
   :super robot-interface
-  :slots ())
+  :slots (gripper-action))
 
 (eval `(defmethod dxl-armed-turtlebot-interface
          ;; dxl-7dof-arm-interface, turtlebot-interfaceのメソッドをそれぞれdefmethodする
@@ -48,4 +48,4 @@
   (send *irtviewer* :change-background #f(0.9 0.9 0.9))
   (send *irtviewer* :draw-objects)
   )
-(warn ";; (dxl-armed-turtlebot-init) ;; for initialize ~%")
+(warn ";; (dxl-armed-turtlebot-init) ;; for initialize ~%")
diff --git a/dxl_armed_turtlebot/euslisp/dxl-armed-turtlebot.l b/dxl_armed_turtlebot/euslisp/dxl-armed-turtlebot.l
@@ -63,6 +63,8 @@
      (send self :method-copying "-pose")
      (send self :method-copying "_joint")
      (send self :method-copying "inverse-kinematics" t)
+     (send self :method-copying "gripper" t)
+     (send self :method-copying "arm" t)
      t))
   (:method-copying
    (substr &optional (use-args nil))
@@ -79,10 +81,12 @@
             ,(if use-args `(send* arm-robot ,me args) `(send arm-robot ,me))
             )
            ))
-       )))
+       )
+     methods))
+
   ;; limbs
-  (:arm (&rest args)
-        (unless args (setq args (list nil))) (send* self :limb :rarm args))
+  ;;(:arm (&rest args)
+  ;;(unless args (setq args (list nil))) (send* self :limb :rarm args))
   )
 
 ;; アーム台車モデル生成関数