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

else
                     if (g_carDirection == CAR_DIR_ST) // 정지.
                     {
                         car_stop();
                     }
                 }

                 //
                 #define CAR_DIR_FW  0   // 전진.
                 #define CAR_DIR_BK  1   // 후진.
                 #define CAR_DIR_LF  2   // 좌회전.
                 #define CAR_DIR_RF  3   // 우회전
                 #define CAR_DIR_ST  4   // 정지.

                 void print_car_info()
                 {
                     String szDir = "#### ERROR ";
                     if (g_carDirection == CAR_DIR_FW)
                         szDir = "Forward";
                     if (g_carDirection == CAR_DIR_BK)
                         szDir = "Backward";
                     if (g_carDirection == CAR_DIR_LF)
                         szDir = "Left";
                     if (g_carDirection == CAR_DIR_RF)
                         szDir = "Right";
                     if (g_carDirection == CAR_DIR_ST)
                         szDir = "Stop";

                     Serial.println("curr dir " + szDir);
                     Serial.println("speed pwm value " +
                 String(g_carSpeed));
                 }

                 //
                 // return 남은 Queue 크기.
                 //
                 int processingCommand(void)
                 {
                     unsigned char cmd_a_process = 0; // cmd none

                     if (isCmdQueue())
                     {
                         //Serial.print("Queue Size ");
                         //Serial.println(isCmdQueue());





                                                   162
   158   159   160   161   162   163   164   165   166   167   168