Autonomous Underwater Free-Floating Manipulation Using MoveIt!