#define MA1 5
#define MA2 6
#define MB1 8
#define MB2 9
void forward(int a) {
digitalWrite(MA1, 1);
digitalWrite(MA2, 0);
digitalWrite(MB1, 1);
digitalWrite(MB2, 0);
delay(a);
}
void backward(int b) {
digitalWrite(MA1, 0);
digitalWrite(MA2, 1);
digitalWrite(MB1, 0);
digitalWrite(MB2, 1);
delay(b);
}
void left(int c) {
digitalWrite(MA1, 1);
digitalWrite(MA2, 0);
digitalWrite(MB1, 0);
digitalWrite(MB2, 1);
delay(c);
}
void right(int d) {
digitalWrite(MA1, 0);
digitalWrite(MA2, 1);
digitalWrite(MB1, 1);
digitalWrite(MB2, 0);
delay(d);
}
void stop2() {
digitalWrite(MA1, 0);
digitalWrite(MA2, 0);
digitalWrite(MB1, 0);
digitalWrite(MB2, 0);
}
void setup() {
pinMode(MA1, OUTPUT);
pinMode(MA2, OUTPUT);
pinMode(MB1, OUTPUT);
pinMode(MB2, OUTPUT);
forward(1000);
right(600);
forward(500);
right(1100);
forward(1000);
right(1100);
forward(500);
right(600);
forward(1000);
stop2();
}
void loop() {
}
Copyright ⓒ TECH79 All right reserved