#include <Servo.h>
Servo girar;
Servo bajar;
Servo abrir;
bool total = LOW;
void setup() {
// put your setup code here, to run once:
pinMode(A0, INPUT);
pinMode(A1, INPUT);
pinMode(A2, INPUT);
pinMode(A3, INPUT);
pinMode(2, INPUT_PULLUP);
girar.attach(3);
bajar.attach(5);
abrir.attach(6);
}
void loop() {
// put your main code here, to run repeatedly:
int hor1 = analogRead(A1);
int ver1 = analogRead(A0);
int hor2 = analogRead(A3);
int ver2 = analogRead(A2);
bajar.write(180-(0.1757*ver1));
if (hor1 > 700) {
girar.write(180);
}
if (hor1 < 300) {
girar.write(0);
}
if(ver2 != 512) abrir.write(180-(0.1757*ver2));
if(hor2 != 512) abrir.write(180-(0.1757*hor2));
if(ver2 == 512 && hor2 == 512) abrir.write(90);
if(digitalRead(2) == LOW) abrir.write(180);
}