#include <Servo.h>
Servo myServo1;
Servo myServo2;
int switcher = 2;
int mode = 0;
void setup() {
// put your setup code here, to run once:
pinMode(A0, OUTPUT);
pinMode(A1, OUTPUT);
pinMode(2, INPUT_PULLUP);
myServo1.attach(A0);
myServo2.attach(A1);
}
void loop() {
int value = digitalRead(2);
if(value == LOW && switcher == 2)
{
switcher = 1;
if (mode != 2)
{
mode++;
}
else
{
mode = 1;
}
}
delay(100);
if(value == HIGH)
{
switcher = 2;
}
if (mode == 1)
{
for (int i = 0; i < 90; i++)
{
myServo1.write(i);
delay(10);
break;
}
delay(150);
for (int i = 0; i < 90; i++)
{
myServo2.write(i);
delay(10);
break;
}
}
if (mode == 2)
{
for (int i = 90; i > 0; i--)
{
myServo2.write(i);
delay(10);
break;
}
delay(150);
for (int i = 90; i > 0; i--)
{
myServo1.write(i);
delay(10);
break;
}
}
}