활동5) ㄷ자 코스 주행 - 함수 이용

#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() {

}