Trajectory Control of a Tethered Underwater Robot System