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