//control torre de perforacion

byte velocidad= 250;

byte velocidad1= 255;

byte velocidad2= 60;

int sensor1=0;

int sensor2=0;

void setup() {

pinMode(2,OUTPUT);//m1

pinMode(3,OUTPUT);//pwm

pinMode(4,OUTPUT);//m1

pinMode(7,INPUT); //sensor1

pinMode(8,INPUT);//sensor2

pinMode(5,OUTPUT);// mesa rot.

// digitalWrite(5,1);

//Serial.begin(9600);

void loop() {

sensor1=digitalRead(7);

sensor2=digitalRead(8);

if (sensor1==0 && sensor2==1)

{abajo();delay(30);paro();delay(650);abajo0();delay(30);paro();delay(650);abajo0();delay(30);paro()
;delay(650);abajo0();delay(30);paro();delay(1000);

abajo0();delay(30);paro();delay(2000);abajo0();delay(30);paro();delay(2000);abajo0();delay(30);par
o();delay(2000);abajo0();delay(30);paro();delay(2000);

abajo0();delay(30);paro();delay(2000);abajo0();delay(30);paro();delay(2000);abajo0();delay(30);par
o();delay(2000);abajo0();delay(30);paro();delay(2000);
abajo0();delay(30);paro();delay(900);abajo0();delay(30);paro();delay(900);abajo0();delay(30);paro(
);delay(900);abajo0();delay(30);paro();delay(900);

abajo0();delay(30);paro();delay(800);abajo0();delay(30);paro();delay(800);abajo0();delay(30);paro(
);delay(800);abajo0();delay(30);paro();delay(700);abajo1();delay(190);paro();delay(400);digitalWrit
e(5,1);delay(2000);paroT();delay(2000);

if (sensor1==1 && sensor2==0){arriba();delay(20);}

//if (sensor1==0 && sensor2==0){arriba();}

}//LOOP

void arriba(){ digitalWrite(2,1);

digitalWrite(4,0);

analogWrite(3,velocidad); digitalWrite(5,0);}

void abajo(){ digitalWrite(2,0);

digitalWrite(4,1);

analogWrite(3,velocidad1); }

void abajo0(){ digitalWrite(2,0);

digitalWrite(4,1);

analogWrite(3,velocidad1); digitalWrite(5,1);}

void paro(){ digitalWrite(2,0);

digitalWrite(4,0);

analogWrite(3,velocidad); }

void paroT(){ digitalWrite(2,0);

digitalWrite(4,0);
analogWrite(3,velocidad);digitalWrite(5,0); }

void abajo1(){ digitalWrite(2,0);

digitalWrite(4,1);

analogWrite(3,velocidad2); }

void codigo(){

digitalWrite(2,1);

digitalWrite(4,0);

analogWrite(3,velocidad);

delay(1000);

digitalWrite(2,0);

digitalWrite(4,1);

analogWrite(3,velocidad1);

delay(1000);