Page 44 - 2
P. 44
// 부저
const int buzzer = 3 ;
// 블루투스 스테이트핀
const int BTState = 2;
//Calculate Battery Level
const float maxBattery = 8.0;
int perVolt;
float voltage = 0.0;
int level;
long previousMillis = -1000*10;
long interval = 1000*10;
unsigned long currentMillis;
int i=0;
int j=0;
int state;
int vSpeed=200; // 모터 기본속도
void setup() {
// Set pins as outputs:
pinMode(motorA1, OUTPUT);
pinMode(motorA2, OUTPUT);
pinMode(motorB1, OUTPUT);
pinMode(motorB2, OUTPUT);
pinMode(lights, OUTPUT);
pinMode(BTState, INPUT);
Serial.begin(9600);
myservo.attach(11);
}
void loop() {
if(digitalRead(BTState)==LOW) { state='S'; }
if(Serial.available() > 0){ state = Serial.read(); }
if (state == '0'){ vSpeed=0; }
else if (state == '1'){ vSpeed=100; }
else if (state == '2'){ vSpeed=180; }
else if (state == '3'){ vSpeed=200; }
else if (state == '4'){ vSpeed=255; }
/*********************** 전진****************************/
//If state is equal with letter 'F', car will go forward!
if (state == 'F') {
analogWrite(motorA1, vSpeed); analogWrite(motorA2, 0);
- 44 -