#define LED 10 //定義 led_1 I/O number is 1
#define KEY 9 //定義 key_1 I/O number is 0
#define IN1 A0
#define IN2 A1
#define IN3 A2
#define IN4 A3
#define ENA A4
#define ENB A5
#define IN11 7
#define IN21 6
#define IN31 5
#define IN41 4
#define ENA1 3
#define ENB1 2
void setup() {
pinMode(LED,OUTPUT); //定義 led_1 I/O is OUTPUT
pinMode(KEY,INPUT_PULLUP); //定義 led_1 I/O is INPUT_PULLUP
pinMode(IN1,OUTPUT); //定義 IN1 I/O is OUTPUT
pinMode(IN2,OUTPUT); //定義 IN2 I/O is OUTPUT
pinMode(IN3,OUTPUT); //定義 IN3 I/O is OUTPUT
pinMode(IN4,OUTPUT); //定義 IN4 I/O is OUTPUT
pinMode(ENA,OUTPUT); //定義 ENA I/O is OUTPUT
pinMode(ENB,OUTPUT); //定義 ENB I/O is OUTPUT
pinMode(IN11,OUTPUT); //定義 IN1 I/O is OUTPUT
pinMode(IN21,OUTPUT); //定義 IN2 I/O is OUTPUT
pinMode(IN31,OUTPUT); //定義 IN3 I/O is OUTPUT
pinMode(IN41,OUTPUT); //定義 IN4 I/O is OUTPUT
pinMode(ENA1,OUTPUT); //定義 ENA I/O is OUTPUT
pinMode(ENB1,OUTPUT); //定義 ENB I/O is OUTPUT
digitalWrite(LED, HIGH); // 熄滅LED燈
}
void loop()
{
digitalWrite(IN1, HIGH); //
digitalWrite(IN2, LOW); //
digitalWrite(IN3, HIGH); //
digitalWrite(IN4, LOW); //
digitalWrite(ENA, HIGH); //
digitalWrite(ENB, HIGH); //
digitalWrite(LED, LOW); // 驅動電機
digitalWrite(IN11, HIGH); //
digitalWrite(IN21, LOW); //
digitalWrite(IN31, HIGH); //
digitalWrite(IN41, LOW); //
digitalWrite(ENA1, HIGH); //
digitalWrite(ENB1, HIGH); //
}
|
