P1

전진: W

후진: S

좌회전: A

우회전: D

공격: '1'키

P2

전진: 위쪽 화살표

후진: 아래쪽

좌회전: 왼쪽

우회전: 오른쪽

공격: 스페이스

#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27, 16, 2);

void setup() {

pinMode(2, OUTPUT); // TRIG

pinMode(3, INPUT); // ECHO

pinMode(9, OUTPUT); // R

pinMode(10, OUTPUT); // G

pinMode(11, OUTPUT); // B

lcd.init();

lcd.backlight();

}

void loop() {

digitalWrite(2, LOW); delayMicroseconds(2);

digitalWrite(2, HIGH); delayMicroseconds(10);

digitalWrite(2, LOW);

long t = pulseIn(3, HIGH);

long d = t / 58;

lcd.clear();

if (d >= 10) {

lcd.setCursor(0, 0); lcd.print("SAFE");

analogWrite(9, 0); analogWrite(10, 200); analogWrite(11, 0);

} else if (d >= 5) {

lcd.setCursor(0, 0); lcd.print("CAUTION");

analogWrite(9, 200); analogWrite(10, 200); analogWrite(11, 0);

} else {

lcd.setCursor(0, 0); lcd.print("STOP");

analogWrite(9, 200); analogWrite(10, 0); analogWrite(11, 0);

}

lcd.setCursor(0, 1);

lcd.print(d); lcd.print(" cm");

delay(300);

}