Removed dependency on moveit_core, unneccesary