#include <Servo.h>;
Servo LGservo;
Servo RGservo;
Servo CGservo;
const int switchlowPin = 2;
int switchlowState = 0;
const int switchupPin = 10;
int switchupState = 0;
void setup() {
pinMode(7, OUTPUT);
pinMode(12, OUTPUT);
pinMode(8, OUTPUT);
pinMode(2, INPUT);
pinMode(10, INPUT);
LGservo.attach(11);
CGservo.attach(6);
RGservo.attach(3);
LGservo.write(0);
CGservo.write(0);
RGservo.write(0);
}
void loop() {
switchlowState = digitalRead(switchlowPin);
if (switchlowState == HIGH) {
LGservo.write(90);
CGservo.write(90);
RGservo.write(90);
digitalWrite(7, HIGH);
if (digitalRead(12) == HIGH) {
digitalWrite(8, HIGH);
digitalWrite(12, LOW);
}
}
if (digitalRead(7) == LOW) {
digitalWrite(12, HIGH);
}
switchupState = digitalRead(switchupPin);
if (switchupState == HIGH) {
LGservo.write(0);
CGservo.write(0);
RGservo.write(0);
digitalWrite(7,LOW);
digitalWrite(12, LOW);
digitalWrite(8, LOW);
}
}