Controller for AUV on UWSim Simulator. The controller is designed to make the robot follow a desired path, acting in x, y, z and yaw.