// modify the state of a servo void Servotor32::changeServo(byte servo, short pos){ if(pos == 0){ pos = -1; } if(pos == -1){ update_registers_fast(servo, pos); } else{ update_registers_fast(servo, pos/10); } }
// modify the state of a servo void Servotor32::changeServo(byte servo, short pos){ if(pos == 0){ pos = -1; } if(pos == -1){ update_registers_fast(servo, pos); if (servo < 15) { pwm.setPWM(servo, 0, 0); } else { pwm2.setPWM(servo - 16, 0, 0); } } else{ update_registers_fast(servo, pos/10); if (servo < 15) { pwm.setPWM(servo, 0, constrain(map(pos, 500, 2500, SERVOMIN, SERVOMAX), 0, 4096)); } else { pwm2.setPWM(servo - 16, 0, constrain(map(pos, 500, 2500, SERVOMIN, SERVOMAX), 0, 4096)); } } }