minor bug fix to resetting servo state