#include <Servo.h>
Servo rightservo, leftservo;
#define BUTTON_PIN 3
#define RED_LED_PIN 2
#define GREEN_LED_PIN 10
#define SWITCH_PIN 12
#define DIAL_PIN A0
#define RIGHTSERVO_PIN 9
#define LEFTSERVO_PIN 6
#define DOWN LOW
int val;
int pos = 90;
int delta=1;
int potpin = 0;
int rightpos=pos;
int leftpos= 180-pos;
void setup() {
pinMode(BUTTON_PIN, INPUT_PULLUP);
pinMode(LED_BUILTIN, OUTPUT);
pinMode(SWITCH_PIN, INPUT);
pinMode(RED_LED_PIN, OUTPUT);
pinMode(GREEN_LED_PIN, OUTPUT);
rightservo.attach(RIGHTSERVO_PIN);
rightservo.write(pos);
delay(150);
leftservo.attach(LEFTSERVO_PIN);
leftservo.write(180-pos);
delay(150);
}
void loop() {
if(digitalRead(SWITCH_PIN)==LOW){
rightservo.write(rightpos);
leftservo.write(leftpos);
digitalWrite(GREEN_LED_PIN, LOW);
digitalWrite(RED_LED_PIN, HIGH);
if(digitalRead(BUTTON_PIN)== DOWN){
rightservo.write(pos);
leftservo.write(180-pos);
rightpos= pos;
leftpos = 180-pos;
}
} else{
digitalWrite(RED_LED_PIN, LOW);
digitalWrite(GREEN_LED_PIN, HIGH);
val=analogRead(potpin);
val= map(val,0,1023,0,180);
rightpos= 180-val;
leftpos= val;
rightservo.write(leftpos);
leftservo.write(rightpos);
delay(10);
}
}