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
   160   161   162   163   164   165   166   167   168   169   170