You are on page 1of 1

// C++ code

int vel1 = 1;
int d1 = 6;
int d2 = 7;
int d3 = 11;
int d4 = 12;
int MotorV1 = 200; //Maximo 255

void setup(){
Serial.begin(vel1, OUTPUT);
pinMode(vel1, OUTPUT);
pinMode(d1, OUTPUT);
pinMode(d2, OUTPUT);
pinMode(d3, OUTPUT);
pinMode(d4, OUTPUT);
}

void loop(){
//Girar a la izquireda
digitalWrite(d1, LOW);
digitalWrite(d2, HIGH);
delay(5000);//Retrasar un poco para mejorar el rendimiento de la simulación.

digitalWrite(d1, LOW);
digitalWrite(d2, LOW);
delay(20);

digitalWrite(d3, HIGH);
digitalWrite(d4, LOW);
delay(5000);
digitalWrite(d3, LOW);
digitalWrite(d4, LOW);
delay(20);

//Girar a la derecha
digitalWrite(d1, HIGH);
digitalWrite(d2, LOW);
delay(5000);//Retrasar un poco para mejorar el rendimiento de la simulación.

digitalWrite(d1, LOW);
digitalWrite(d2, LOW);
delay(20);

digitalWrite(d3, LOW);
digitalWrite(d4, HIGH);
delay(5000);
digitalWrite(d3, LOW);
digitalWrite(d4, LOW);
delay(20);

analogWrite(vel1, MotorV1);
// delay(10);
}

You might also like