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

cmdEnQueue("2"); // 전방
}
else
if (newDirection == DIR_DISC_RIGHT)
{
Serial.println("RIGHT =====>>>>> ");
//g_carDirection = CAR_DIR_RF;
cmdEnQueue("6"); // 6
cmdEnQueue("D"); // delay 100 ms
cmdEnQueue("D"); // delay 100 ms
cmdEnQueue("D"); // delay 100 ms
cmdEnQueue("D"); // delay 100 ms
cmdEnQueue("2"); // 전방
}
//
print_car_info();
car_update();
g_carDirection = CAR_DIR_FW;
car_update();
return;
}
Serial.println(">>");
Serial.print("Unknown cmd ");
Serial.println(szIRCmd);
}

void init_car_controller_board()
{
pinMode(ENA, OUTPUT); // ENA
pinMode(EN1, OUTPUT); // EN1
pinMode(EN2, OUTPUT); // EN2

pinMode(ENB, OUTPUT); // ENB
pinMode(EN3, OUTPUT); // EN3
pinMode(EN4, OUTPUT); // EN4
}

//
// 전후좌우 4 개의 함수는 테스트시
// DC 모터 연결에 맞게 고쳐서 정정해야 합니다.
// DC 모터 연결 (+)(-) 연결 변경하거나 코드를 변경합니다.
void car_forward()
{

159