#define MA1 9
#define MA2 10
#define MB1 5
#define MB2 6
void forward() { // 전전
digitalWrite(MA1, 1);
digitalWrite(MA2, 0);
digitalWrite(MB1, 1);
digitalWrite(MB2, 0);
delay(1000);
}
void backward() { // 후진
digitalWrite(MA1, 0);
digitalWrite(MA2, 1);
digitalWrite(MB1, 0);
digitalWrite(MB2, 1);
delay(1000);
}
void left() { // 좌회전
digitalWrite(MA1, 0);
digitalWrite(MA2, 1);
digitalWrite(MB1, 1);
digitalWrite(MB2, 0);
delay(500);
}
void right() { // 우회전
digitalWrite(MA1, 1);
digitalWrite(MA2, 0);
digitalWrite(MB1, 0);
digitalWrite(MB2, 1);
delay(500);
}
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(); // 전진
left(); // 좌회전
forward(); // 전진
left(); // 좌회전
forward(); // 전진
stop2(); // 정지
}
void loop() {
}
Copyright ⓒ TECH79 All right reserved