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 -
   39   40   41   42   43   44   45   46   47   48   49