usrsdm_controller Underwater Snake Robot with Screw-drive Mechanism (USR-SDM) controller Using UWsim.