Merge pull request #442 from knorth55/fix-pr2eus-moveit-bodies

[pr2eus_moveit] evaluate all bodies only when it has bodies
jsk-ros-pkg · Aug 13, 2020 · a228cc7 · a228cc7
2 parents 4102b8d + 9f590e0
commit a228cc7
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/pr2eus_moveit/euslisp/collision-object-publisher.l b/pr2eus_moveit/euslisp/collision-object-publisher.l
@@ -105,7 +105,8 @@
        (let ((org-cds (send obj :copy-worldcoords)))
          (send obj :reset-coords)
          (send obj :worldcoords)
-         (mapcar #'(lambda (body) (send body :worldcoords)) (send obj :bodies))
+         (when (find-method obj :bodies)
+           (mapcar #'(lambda (body) (send body :worldcoords)) (send obj :bodies)))
          (let ((fs (body-to-faces obj))
                (geom (instance shape_msgs::mesh :init))
                idx-lst vertices (cntr 0))