Page 165 - 최강 아두이노 스마트 자동차 로봇 키트
P. 165
{
Serial.begin(9600);
//
initSystem();
// 정지 상태.
}
void loop()
{
// 앞부분 거리 측정.
g_DistanceDirValue.center =
measureDirDistance(SERVO_DIR_CENTER);
//Serial.println(g_DistanceDirValue.center);
//
while (processingCommand()>0);
//
if (g_DistanceDirValue.isAlertForward()) // alert
{
Serial.println("### Alert Forward ## " +
String(g_DistanceDirValue.center));
car_stop(); // 모터정지
Serial.println("Stopped Car");
//buzzer(0); // 부저
// 3 방향이 모두 짧은 거리로 판단되는 경우.
// 손으로 3 방향 가까이 가리는 경우 정지, 시작.
if (isOperateModeChange())
{
if (g_carUserMode == CAR_OPERATE_MODE_DISABLE)
{
Serial.println("Starting....");
startSystem();
delay(1000); //
}
else
{
Serial.println("Stopping by USER??");
breakeSystem();
delay(2500); // 2.5 초 잠시 정지.
}
164