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