AI 모빌리티 공학 캠프 (중2)
제공 코드26차시, 전륜, 후륜 키트 블루투스 주행과 조향 (원본)
| 언어 | Arduino C++ |
|---|---|
| 설명 | 키트 기본 코드입니다. '1' 전진, '2' 후진, '3' 정지, 'L'/'R'/'M' 조향(서보 180/100/140). 시리얼 출력 문구 일부 생략. AFMotor 라이브러리 필요 |
#include <AFMotor.h>
#include <SoftwareSerial.h>
#include <Servo.h>
int BluetoothData;
const int rxPin = A0;
const int txPin = A5;
SoftwareSerial mySerial(rxPin, txPin); // RX, TX
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
Servo servo1;
void setup() {
Serial.begin(115200);
mySerial.begin(115200);
motor1.setSpeed(250);
motor1.run(RELEASE);
motor2.setSpeed(250);
motor2.run(RELEASE);
servo1.attach(9);
}
void loop() {
if (mySerial.available()) {
BluetoothData = mySerial.read();
if (BluetoothData == '1') { // go
motor1.run(FORWARD);
motor2.run(FORWARD);
delay(1000);
}
if (BluetoothData == '2') { // back
motor1.run(BACKWARD);
motor2.run(BACKWARD);
delay(1000);
}
if (BluetoothData == '3') { // stop
motor1.run(RELEASE);
motor2.run(RELEASE);
delay(1000);
}
if (BluetoothData == 'R') { servo1.write(100); delay(200); }
if (BluetoothData == 'L') { servo1.write(180); delay(200); }
if (BluetoothData == 'M') { servo1.write(140); delay(200); }
}
}AI 모빌리티 공학 캠프 (중2)
제공 코드8~10차시, 2센서 라인트레이싱 (재구성)
| 언어 | Arduino C++ |
|---|---|
| 설명 | 키트 구성(L293D 쉴드, TT 모터, TCRT5000)에 맞춰 새로 작성. THRESHOLD는 센서 값 측정표의 기준값으로 바꾼다 |
#include <AFMotor.h>
AF_DCMotor left(1);
AF_DCMotor right(2);
const int SENSOR_L = A1;
const int SENSOR_R = A2;
const int THRESHOLD = 500; // from your measurement sheet
const int SPEED = 150;
const int TURN = 90;
void drive(int l, int r) {
left.setSpeed(abs(l));
right.setSpeed(abs(r));
left.run(l >= 0 ? FORWARD : BACKWARD);
right.run(r >= 0 ? FORWARD : BACKWARD);
}
void setup() {
Serial.begin(9600);
}
void loop() {
bool onL = analogRead(SENSOR_L) > THRESHOLD; // true = black line
bool onR = analogRead(SENSOR_R) > THRESHOLD;
if (!onL && !onR) drive(SPEED, SPEED); // straight
else if (onL && !onR) drive(TURN, SPEED); // line on left: turn left
else if (!onL && onR) drive(SPEED, TURN); // line on right: turn right
else { left.run(RELEASE); right.run(RELEASE); } // both black: stop line
}AI 모빌리티 공학 캠프 (중2)
제공 코드14~16차시, 비례 제어 라인 주행 (재구성)
| 언어 | Arduino C++ |
|---|---|
| 설명 | 회전량 = Kp × 오차(y = kx). 오차는 두 센서 값의 차이로 계산. Kd를 0보다 크게 하면 PD 제어(16차시 심화) |
#include <AFMotor.h>
AF_DCMotor left(1);
AF_DCMotor right(2);
float Kp = 0.15; // try 0.05, 0.1, 0.2, 0.4
float Kd = 0.0; // PD option (session 16)
const int BASE = 140;
int prevError = 0;
void setup() {}
void loop() {
int error = analogRead(A1) - analogRead(A2); // >0: line on left
int turn = Kp * error + Kd * (error - prevError);
prevError = error;
int l = constrain(BASE - turn, 0, 255);
int r = constrain(BASE + turn, 0, 255);
left.setSpeed(l); left.run(FORWARD);
right.setSpeed(r); right.run(FORWARD);
delay(10);
}AI 모빌리티 공학 캠프 (중2)
제공 코드16차시, PD 계산 구조 읽기 (실습코드 PID 클래스 축약)
| 언어 | Python |
|---|---|
| 설명 | PID에서 I 항과 포화 처리를 빼고 중2 수준으로 줄인 코드 |
def clamp(value, low, high):
return max(low, min(high, value))
class PD:
def __init__(self, kp=0.55, kd=0.08, limit=0.48):
self.kp, self.kd, self.limit = kp, kd, limit
self.previous = None
def update(self, error, dt):
# change of error per second
derivative = 0 if self.previous is None else (error - self.previous) / dt
self.previous = error
return clamp(self.kp * error + self.kd * derivative, -self.limit, self.limit)
pd = PD()
for error in [0.10, 0.08, 0.05, 0.01, -0.02]:
print(round(pd.update(error, 0.1), 3))AI 모빌리티 공학 캠프 (중2)
제공 코드25~26차시, 정지 표지 인식 후 정지와 재출발 상태 (재구성)
| 언어 | Python |
|---|---|
| 설명 | 교사 PC에서 인식 결과(label, 확신도)를 받아 블루투스 명령('1' 전진, '3' 정지)을 보낸다. send()는 교사 PC 연결 방식에 맞게 바꾼다 |
import time
STOP_SECONDS = 3 # stop time at sign
IGNORE_SECONDS = 4 # ignore the same sign after restart
MIN_CONF = 0.7 # below this: slow down instead of trusting
state = "DRIVE"
t_mark = 0.0
def send(cmd):
print("bluetooth ->", cmd) # replace with serial write
def step(label, conf, now):
global state, t_mark
if state == "DRIVE":
if label == "stop" and conf >= MIN_CONF:
state, t_mark = "STOP", now
send("3")
elif label == "stop":
send("1") # uncertain: keep slow (set lower speed on car)
elif state == "STOP":
if now - t_mark >= STOP_SECONDS:
state, t_mark = "RESTART", now
send("1")
elif state == "RESTART":
if now - t_mark >= IGNORE_SECONDS:
state = "DRIVE" # sign can be detected again
for label, conf in [("none", 0.9), ("stop", 0.85), ("stop", 0.9), ("stop", 0.9)]:
step(label, conf, time.time())
time.sleep(1.2)