Sei sulla pagina 1di 4

Codigo para probar 2 motores con Puente H

#define m11 11 // rear motor

#define m12 12

#define m21 10 // front motor

#define m22 9

String data;

void forward()

digitalWrite(m11, LOW);

digitalWrite(m12, LOW);

digitalWrite(m21, HIGH);

digitalWrite(m22, LOW);

void backward()

digitalWrite(m11, LOW);

digitalWrite(m12, LOW);

digitalWrite(m21, LOW);

digitalWrite(m22, HIGH);

void left()

digitalWrite(m11, HIGH);

digitalWrite(m12, LOW);

delay(100);

digitalWrite(m21, HIGH);
digitalWrite(m22, LOW);

void right()

digitalWrite(m11, LOW);

digitalWrite(m12, HIGH);

delay(100);

digitalWrite(m21, HIGH);

digitalWrite(m22, LOW);

void Stop()

digitalWrite(m11, LOW);

digitalWrite(m12, LOW);

digitalWrite(m21, LOW);

digitalWrite(m22, LOW);

void setup()

Serial.begin(9600);

pinMode(m11, OUTPUT);

pinMode(m12, OUTPUT);

pinMode(m21, OUTPUT);

pinMode(m22, OUTPUT);

void loop(){
if(Serial.available()){

delay(100);

data = "";

while(Serial.available()){

char c= Serial.read();

data+=c;

if(data == "upPress"){forward();}

else if(data == "upRelease"){ Stop();}

else if(data == "downPress"){ backward();}

else if(data == "downRelease"){ Stop();}

else if(data == "leftPress"){ left();}

else if(data == "leftRelease"){ Stop();}

else if(data == "rightPress"){ right();}

else if(data == "rightRelease"){ Stop();}

if(data == "triangelPress"){ /*code program action here*/}

else if(data == "triangelRelease"){ /*code program action here*/}

if(data == "xPress"){ /*code program action here*/}

else if(data == "xRelease"){ /*code program action here*/}

if(data == "squarePress"){ /*code program action here*/}

else if(data == "squareRelease"){ /*code program action here*/}

if(data == "circlePress"){ /*code program action here*/}

else if(data == "circleRelease"){ /*code program action here*/}


}

Potrebbero piacerti anche