示例#1
0
// 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);
  }
}
示例#2
0
// 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));
    }
  }
}