AI 모빌리티 공학 캠프 (고등)
제공 코드1일차 ③, 적외선 라인트레이서 제공 코드 (센서 2개, 모터 2개)
| 언어 | cpp |
|---|---|
| 설명 | 1일차에 쓰는 코드입니다. AFMotor 라이브러리, 모터 드라이버 쉴드 L293D(M1 왼쪽, M4 오른쪽), 센서 OUT은 A0와 A5. 2일차 다듬기 시간에는 setSpeed 값을 바꾼다. |
#include <SoftwareSerial.h>
#include <AFMotor.h>
AF_DCMotor motor_L(1); // L293D shield: M1
AF_DCMotor motor_R(4); // L293D shield: M4
void setup() {
Serial.begin(9600);
Serial.println("Eduino Smart Car Start!");
// turn on motor
motor_L.setSpeed(230); // left motor speed (0-255)
motor_L.run(RELEASE);
motor_R.setSpeed(230); // right motor speed
motor_R.run(RELEASE);
}
void loop() {
int val1 = digitalRead(A0); // line sensor 1
int val2 = digitalRead(A5); // line sensor 2
if (val1 == 0 && val2 == 0) { // straight
motor_L.run(FORWARD);
motor_R.run(FORWARD);
}
else if (val1 == 0 && val2 == 1) { // turn right
motor_L.run(FORWARD);
motor_R.run(RELEASE);
}
else if (val1 == 1 && val2 == 0) { // turn left
motor_L.run(RELEASE);
motor_R.run(FORWARD);
}
else if (val1 == 1 && val2 == 1) { // stop
motor_L.run(RELEASE);
motor_R.run(RELEASE);
}
}