fixed servo lag issue in cylon_leap_SERVO