Added error catching in our servo functions