#include <Arduino.h>

#define PWMA 21
#define AIN2 19
#define AIN1 18
#define STBY 5

void setup() {
  Serial.begin(9600);

  // 初始化腳位模式 (輸出)
  pinMode(PWMA, OUTPUT);
  pinMode(AIN2, OUTPUT);
  pinMode(AIN1, OUTPUT);
  pinMode(STBY, OUTPUT);
}

void loop() {
  // 設定馬達速度為 255(0~255)
  setSpeed(255);
  // 馬達前進
  forward();
  Serial.println("forward");
  delay(1000);

  // 設定馬達速度為 100(0~255)
  setSpeed(100);
  // 馬達後退
  back();
  Serial.println("back");
  delay(1000);

  // 馬達關閉
  stop();
  Serial.println("stop");
  delay(1000);
}

void forward() {
  digitalWrite(AIN1, HIGH);
  digitalWrite(AIN2, LOW);
  digitalWrite(STBY, HIGH);
}

void back() {
  digitalWrite(AIN1, LOW);
  digitalWrite(AIN2, HIGH);
  digitalWrite(STBY, HIGH);
}

void stop() {
  digitalWrite(AIN1, LOW);
  digitalWrite(AIN2, LOW);
  digitalWrite(STBY, HIGH);
}

void setSpeed(uint8_t speed) {
  analogWrite(PWMA, speed);
}