fix SeeShape equivalence problem
Merge branch 'groovy-devel' of github.com:ros-planning/moveit_ros into groovy-devel