Skip to content

Commit f95ebfa

Browse files
committed
[hrpsys_ros_bridge_tutorials] Re-enable to use {limb}-controller in real HIRONXJSK
#4 (comment) includes misunderstanding
1 parent 3068f57 commit f95ebfa

File tree

1 file changed

+6
-1
lines changed

1 file changed

+6
-1
lines changed

hrpsys_ros_bridge_tutorials/euslisp/hironxjsk-interface.l

Lines changed: 6 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -34,7 +34,12 @@
3434
args)
3535
(dolist (limb '(:rarm :larm :head :torso))
3636
(let ((ctype (read-from-string (format nil "~A-controller" limb))))
37-
(send self :add-controller ctype)))
37+
;; If :gazebo-ros-controller was passed to *ri* init, {limb}-controller's action was already created, so we just register it as {limb}-controller
38+
(unless (send self :add-controller ctype)
39+
;; If :default-controller was passed to *ri* init, {limb}-controller's action was not created, so we create it.
40+
;; If we create it when :gazebo-ros-controller was passed, "old client's goal" warning is showed after :angle-vector
41+
(send self :add-controller ctype
42+
:joint-enable-check t :create-actions t))))
3843

3944
;; add hand controller for gazebo with ros_control
4045
(when on-gazebo-ros-control

0 commit comments

Comments
 (0)