Mạch Điều Khiển Động Cơ Bước TB6560 3A

// Khai báo các chân điều khiển
const int stepPin = 2;
const int dirPin = 3;
const int enablePin = 4;

// Thiết lập biến cho các thông số động cơ bước
const int stepsPerRevolution = 200;
const int stepsPerMM = 80;
const int speed = 1000;

void setup() {
  // Thiết lập chân đầu ra
  pinMode(stepPin, OUTPUT);
  pinMode(dirPin, OUTPUT);
  pinMode(enablePin, OUTPUT);
  
  // Khởi động tốc độ 0 và ngừng động cơ
  digitalWrite(enablePin, HIGH);
  digitalWrite(dirPin, LOW);
  digitalWrite(stepPin, LOW);
}

void loop() {
  // Thiết lập hướng quay
  digitalWrite(dirPin, HIGH); // quay theo chiều dương trục X
  
  // Tính toán số bước cần đi
  int stepsToTake = stepsPerMM * 50; // di chuyển 50mm
  
  // Tính thời gian trễ giữa các bước
  int delayBetweenSteps = speed / stepsPerMM;
  
  // Khởi động động cơ
  digitalWrite(enablePin, LOW);
  
  // Di chuyển động cơ
  for(int i = 0; i < stepsToTake; i++) {
    digitalWrite(stepPin, HIGH);
    delayMicroseconds(delayBetweenSteps);
    digitalWrite(stepPin, LOW);
    delayMicroseconds(delayBetweenSteps);
  }
  
  // Dừng động cơ
  digitalWrite(enablePin, HIGH);
  delay(1000); // Dừng trong 1 giây
  
  // Thiết lập hướng quay ngược lại
  digitalWrite(dirPin, LOW); // quay theo chiều âm trục X
  
  // Di chuyển động cơ
  for(int i = 0; i < stepsToTake; i++) {
    digitalWrite(stepPin, HIGH);
    delayMicroseconds(delayBetweenSteps);
    digitalWrite(stepPin, LOW);
    delayMicroseconds(delayBetweenSteps);
  }
  
  // Dừng động cơ
  digitalWrite(enablePin, HIGH);
  delay(1000); // Dừng trong 1 giây
}