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

struct DistanceDir g_DistanceDirValue;

//
// measure distance
//
int measureDirDistance(int iDir)
{
// servo motor rotate
setRotateServo(iDir);

delay(11);//wait for servo.
int currDistance = getSafeDistance();
return currDistance;
}

//

// direction
//
int decisionDirection()
{
g_DistanceDirValue.left =
measureDirDistance(SERVO_DIR_LEFT);
delay(700);
g_DistanceDirValue.right =

measureDirDistance(SERVO_DIR_RIGHT);
delay(700);
g_DistanceDirValue.center =
measureDirDistance(SERVO_DIR_CENTER);
delay(700);
int finalDir = g_DistanceDirValue.getProperDir();

return finalDir;
}
//
// int iDir : 방향 설정 변수
//

141