#include <Servo.h>
int servo1 = 11;
int servo2 = 10;
int servo3 = 9;
int button1 = 2;
int button2 = 3;
int button3 = 4; // 800 Kyats
int button4 = 5; //200 Kyats
int dt1 = 100; // Tapping delay
int dt2 = 200; // delay time of after tap of each Servo
int degree1 =110; // The degree of Servo to tap
int degree2 = 90; // The degree of Servo to stap back after tap (servo Position)
int buttonSig1;
int buttonSig2;
int buttonSig3;
int buttonSig4;
Servo myServo1;
Servo myServo2;
Servo myServo3;
void setup()
{
pinMode(button1,INPUT_PULLUP);
pinMode(button2,INPUT_PULLUP);
pinMode(button3,INPUT_PULLUP);
pinMode(button4,INPUT_PULLUP);
myServo1.attach(servo1);
myServo2.attach(servo2);
myServo3.attach(servo3);
/* digitalWrite(button1,HIGH);
digitalWrite(button2,HIGH);
digitalWrite(button3,HIGH);
digitalWrite(button4,HIGH);*/
Serial.begin(9600);
}
void loop() {
// put your main code here, to run repeatedly:
buttonSig1 = digitalRead(button1);
buttonSig2 = digitalRead(button2);
buttonSig3 = digitalRead(button3);
buttonSig4 = digitalRead(button4);
Serial.println(buttonSig1);
delay(200);
// 200 Kyats
if (buttonSig4==0)
{
myServo1.write(degree1);
delay(dt1);
myServo1.write(degree2);
delay(dt2);
myServo2.write(degree1);
delay(dt1);
myServo2.write(degree2);
delay(dt2);
myServo3.write(degree1);
delay(dt1);
myServo3.write(degree2);
delay(dt2);
}
// 400 Kyats
if (buttonSig1==0)
{
myServo1.write(degree1);
delay(dt1);
myServo1.write(degree2);
delay(dt2);
myServo2.write(degree1);
delay(dt1);
myServo2.write(degree2);
delay(dt2);
for (int x = 1;x<3;x++)
{
myServo3.write(degree1);
delay(dt1);
myServo3.write(degree2);
delay(dt1);
}
}
// 800 Kyats
if (buttonSig2==0)
{
myServo1.write(degree1);
delay(dt1);
myServo1.write(degree2);
delay(dt2);
myServo2.write(degree1);
delay(dt1);
myServo2.write(degree2);
delay(dt2);
for (int x = 1;x<5;x++)
{
myServo3.write(degree1);
delay(dt1);
myServo3.write(degree2);
delay(dt1);
}
}
// 1600 Kyats
if (buttonSig3==0)
{
myServo1.write(degree1);
delay(dt1);
myServo1.write(degree2);
delay(dt2);
myServo2.write(degree1);
delay(dt1);
myServo2.write(degree2);
delay(dt2);
for (int x = 1;x<9;x++)
{
myServo3.write(degree1);
delay(dt1);
myServo3.write(degree2);
delay(dt1);
}
}
}