Change color servo, anti jamming code`