Page 364 - MDP2022-2

2. 코드
Arduino :
#include <SoftwareSerial.h>
#include <Servo.h>
Servo servo;

int up = 2;
int down = 3;
int left = 4;
int right = 5;
int drop = 10;
int isturn = 0;
int dropflag = 13;
char input1;

bool u = false;
bool d = false;
bool l = false;
bool r = false;

SoftwareSerial BTSerial(9, 8);
void setup() {
Serial.begin(9600);
BTSerial.begin(9600);
servo.attach(6);
for (int i = 2; i <= 6; i++)
pinMode(i, OUTPUT);
pinMode(7, INPUT);
pinMode(10, OUTPUT);
servo.write(90);
}

void loop() {
if (BTSerial.available()) {
input1 = BTSerial.read();
}
else if (Serial.available()) {
input1 = Serial.read();
}
if (input1 == '0') {
Serial.print("stop\n");
digitalWrite(up, 0);
digitalWrite(down, 0);
digitalWrite(left, 0);