#include <Servo.h>
Servo myServo;
Servo myServo2;
Servo myServo3;
Servo myServo4;
int Ppin1 = A0;
int Ppin2 = A1;
int Ppin3 = A2;
int Ppin4 = A3;
int Value1;
int Value2;
int Value3;
int Value4;
const int ButtonPin = 2;
const int LedPin = 4;
int LedState = LOW;
int PreviousButtonState;
int CurrentButtonState;
void setup() {
myServo.attach(8);
myServo2.attach(9);
myServo3.attach(10);
myServo4.attach(11);
pinMode(ButtonPin, INPUT);
pinMode(LedPin, OUTPUT);
CurrentButtonState = digitalRead(ButtonPin);
}
void loop() {
// put your main code here, to run repeatedly:
Value1 = analogRead(Ppin1);
Value1 = map(Value1,0,1023,0,180);
myServo4.write(Value1);
Value2 = analogRead(Ppin2);
Value2 = map(Value2,0,1023,0,180);
myServo3.write(Value2);
Value3 = analogRead(Ppin3);
Value3 = map(Value3,0,1023,0,180);
myServo2.write(Value3);
Value4 = analogRead(Ppin4);
Value4 = map(Value4,0,1023,0,180);
myServo.write(Value4);
PreviousButtonState = CurrentButtonState;
CurrentButtonState = digitalRead(ButtonPin);
if(PreviousButtonState == HIGH && CurrentButtonState == LOW) {
if(LedState == LOW)
LedState = HIGH;
else
LedState = LOW;
digitalWrite(LedPin, LedState);
}
if (LedState = LOW){
myServo.write(90);
myServo2.write(90);
myServo3.write(90);
myServo4.write(90);
}
else{
myServo.write(Value1);
myServo2.write(Value2);
myServo3.write(Value3);
myServo4.write(Value4);
}
}