5.2.4. 방향을 표시하는 자동차 만들기 2

CODE 5.7 | 3색 LED로 주행 상태 표시하기

01	// 모터 제어 핀 설정
02	int rightMotor1 = 5;
03	int rightMotor2 = 6;
04	int leftMotor1 = 9;
05	int leftMotor2 = 10;
06
07	// 3색 LED 핀 설정
08	int pinR = 2; // 빨간색 LED
09	int pinG = 3; // 초록색 LED
10	int pinB = 4; // 파란색 LED
11
12	void setup() {
13	// 모터 핀을 출력 모드로 설정
14	pinMode(rightMotor1, OUTPUT);
15	pinMode(rightMotor2, OUTPUT);
16	pinMode(leftMotor1, OUTPUT);
17	pinMode(leftMotor2, OUTPUT);
18
19	// 3색 LED 핀을 출력 모드로 설정
20	pinMode(pinR, OUTPUT);
21	pinMode(pinG, OUTPUT);
22	pinMode(pinB, OUTPUT);
23	}
24
25	void loop() {
26	// 1. 전진 및 초록색 출력
27	digitalWrite(pinR, LOW);
28	digitalWrite(pinG, HIGH);
29	digitalWrite(pinB, LOW);
30
31	digitalWrite(rightMotor1, HIGH); // 오른쪽 바퀴 전진
32	digitalWrite(rightMotor2, LOW);
33	digitalWrite(leftMotor1, HIGH); // 왼쪽 바퀴 전진
34	digitalWrite(leftMotor2, LOW);
35	delay(2000);
36
37	// 2. 우회전 및 파란색 출력
38	digitalWrite(pinR, LOW);
39	digitalWrite(pinG, LOW);
40	digitalWrite(pinB, HIGH);
41
42	digitalWrite(rightMotor1, LOW); // 오른쪽 바퀴 정지
43	digitalWrite(rightMotor2, LOW);
44	digitalWrite(leftMotor1, HIGH); // 왼쪽 바퀴 전진
45	digitalWrite(leftMotor2, LOW);
46	delay(2000);
47
48	// 3. 좌회전 및 파란색 출력
49	digitalWrite(pinR, LOW);
50	digitalWrite(pinG, LOW);
51	digitalWrite(pinB, HIGH);
52
53	digitalWrite(rightMotor1, HIGH); // 오른쪽 바퀴 전진
54	digitalWrite(rightMotor2, LOW);
55	digitalWrite(leftMotor1, LOW); // 왼쪽 바퀴 정지
56	digitalWrite(leftMotor2, LOW);
57	delay(2000);
58
59	// 4. 정지 및 빨간색 출력
60	digitalWrite(pinR, HIGH);
61	digitalWrite(pinG, LOW);
62	digitalWrite(pinB, LOW);
63
64	digitalWrite(rightMotor1, LOW); // 양쪽 바퀴 정지
65	digitalWrite(rightMotor2, LOW);
66	digitalWrite(leftMotor1, LOW);
67	digitalWrite(leftMotor2, LOW);
68	delay(2000);
69	}