Fixing servos - handling the one that goes backwards