Added clamping redundancy

Trying to get rid of servo jitter so added a second check to make sure
servo values are not outside of range.