A thruster failure tolerant control scheme for underwater vehicles