Page 71 - 최강 아두이노 스마트 자동차 로봇 키트
P. 71
#define EN2 3 // 모터 1 번 방향 설정 포트.
#define EN3 4 // 모터 2 번 속도 제어 포트
#define EN4 2 // 모터 2 번 방향 포트
#define ENB 5 // 모터 2 번 속도 제어. PWM 포트.
// 부팅 후 1 회 실행되는 함수. 초기화 함수. Setup()
void setup()
{
pinMode(ENA, OUTPUT); // ENA
pinMode(EN1, OUTPUT); // EN1
pinMode(EN2, OUTPUT); // EN2
pinMode(ENB, OUTPUT); // ENB
pinMode(EN3, OUTPUT); // EN3
pinMode(EN4, OUTPUT); // EN4
}
// 계속 실행되는 함수. loop()
void loop()
{
if(direction == FORWARD) // 전진
{
digitalWrite(EN1, LOW);
digitalWrite(EN2, HIGH;
analogWrite(ENA, speed);
digitalWrite(EN3, LOW);
digitalWrite(EN4, HIGH);
analogWrite(ENB, speed);
}
70