Vous êtes sur la page 1sur 2

//motor 1

int enA=8;
int in1=7;
int in2=6;

//motor 2
int enB= 9;
int in3=5;
int in4=4;

char A;

void setup(){
Serial.begin(9600);
Serial.println("Serial Ready");
pinMode(enA, OUTPUT);
pinMode(enB, OUTPUT);
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);
pinMode(3, OUTPUT);
}

void loop(){
if (Serial.available()>0){
A=Serial.read();
Serial.println(A);
}
if(A=='F'){
f();
}
else if(A=='B'){
b();
}
if(A=='1'){
stop1();
}
if(A=='2'){
stop2();
}

if(A=='0'){
h() ;
}
if(A=='8'){

digitalWrite(3,HIGH);
}

if(A=='9'){
digitalWrite(3,LOW);
}
if(A=='L'){
l();
}
else if(A=='R'){
r();
}
delay(100);
A = ' ';
}

void f(){
digitalWrite(in1,LOW);
digitalWrite(in2,HIGH);
analogWrite(enA,100);
}
void b(){
digitalWrite(in1,HIGH);
digitalWrite(in2,LOW);
analogWrite(enA,100);
}

void l(){
digitalWrite(in3,LOW);
digitalWrite(in4,HIGH);
}
void r(){
digitalWrite(in4,LOW);
digitalWrite(in3,HIGH);
}
void stop1(){
digitalWrite(in1,LOW);
digitalWrite(in2,LOW);
analogWrite(enA,100);

}
void stop2(){
digitalWrite(in3,LOW);
digitalWrite(in4,LOW);
analogWrite(enA,100);

}
void h(){

pinMode(in1, LOW);
pinMode(in2, LOW);
pinMode(in3, LOW);
pinMode(in4, LOW);

Vous aimerez peut-être aussi