MoveIt!: Autonomous Underwater Free-Floating Manipulation
FCL: A general purpose library for collision and proximity queries