Page 143 - 최강 아두이노 스마트 자동차 로봇 키트
P. 143

int setRotateServo(int iDir)
                 {

                   switch ( iDir )
                   {
                     case   SERVO_DIR_CENTER:
                       myservo.write(85-0);
                       break;
                     case   SERVO_DIR_LEFT:
                       myservo.write(85+40);

                       break;
                     case   SERVO_DIR_RIGHT:
                       myservo.write(85-40);
                       break;
                     default:
                       //  지정된 함수 인자가 아닐 경우 처리.

                       String errMsg="called int setRotateServo(int ";
                       errMsg += iDir;
                       errMsg += ")";
                       Serial.println(errMsg);
                       break;
                    }
                 }


                 // initialize system.
                 void initSystem()
                 {
                   myservo.attach(9);     //  attaches  the  servo  on  pin  9  to  the
                 servo object
                   setRotateServo(SERVO_DIR_CENTER);

                   delay(3000); // 3  초 지연. just delay at first time.
                   setRotateServo(SERVO_DIR_LEFT);
                   delay(300);
                   setRotateServo(SERVO_DIR_RIGHT);
                   delay(1000);





                                                   142
   138   139   140   141   142   143   144   145   146   147   148