fix #157 in moveit_ros