Make: Robotic Arms

159Chapter 8: Rotary Encoder Control

if(motorSelector == 1){

posOne+=5;

}

else if(motorSelector == 2){

posTwo+=5;

posThree-=5;

}

else if(motorSelector == 3){

posFour+=5;

}

else if(motorSelector == 4){

posFive+=5;

}

}

servoOne.write(posOne);

servoTwo.write(posTwo);

servoThree.write(posThree);

servoFour.write(posFour);

servoFive.write(posFive);

Serial.print("Servo One: ");

Serial.print(posOne);

Serial.print(" Servo Two: ");

Serial.print(posTwo);

Serial.print(" Servo Three: ");

Serial.print(posThree);

Serial.print(" Servo Four: ");

Serial.print(posFour);

Serial.print(" Servo Five: ");

Serial.println(posFive);

}

lastStateCLK = currentStateCLK; ...