Mạch điều khiển động cơ bước TB6600 4.5A với Arduino

13

TB6600 4.5A

TB6600 4.5A là một mạch điều khiển động cơ bước thích hợp để xây dựng không chỉ các hệ thống CNC nghiệp dư mà còn cả những hệ thống chuyên nghiệp dựa trên động cơ công suất cao. So với thế hệ trước của TB6560AHG, điện áp của TB6600 phiên bản lần này đã được nâng lên 45V (khuyên dùng 32VDC), dòng hoạt động cũng tăng lên 4.5A.

Module này có một số chức năng an toàn như sau:

• Bảo vệ quá dòng
• Bảo vệ sụt áp
• Bảo vệ quá nhiệt

Thông số kỹ thuật:

• Điện áp hoạt động: 10~45 VDC (khuyên dùng 32 VDC)
• Dòng tối đa: 4.5A.
• Có thể điều khiển full, 1/4, 1/8, 1/16  bước.
• Kích thước: 82 x 50 x 35 (LxWxH)

Sơ đồ chân của trình điều khiển động cơ bước TB6600

Nguồn

• VCC : Cấp nguồn 10~45 VDC.
• GND : Cấp nguồn 0V.
• A+, A-: Ngõ ra cuộn 1 kích động cơ bước
• B+, B- : Ngõ ra cuộn 2 kích động cơ bước 

Tín hiệu

• CLK- : Tạo xung điều khiển động cơ.
• CW- : Lựa chọn quay thuận nghịch.
• ENA- : Cho phép hoạt động.
• 5V : Điện áp 5V

Chân	Mô tả chân
ENA-	Enable Pin(-)
CW-	Tín hiệu cấp xung đảo chiều (-)
CLK-	Tín hiệu cấp xung điều khiển bước quay động cơ (-)
5V	Kết nối điện áp 5V
B-	Cuộn dây 1 động cơ bước
B+	Cuộn dây 1 động cơ bước
A-	Cuộn dây 2 động cơ bước
A+	Cuộn dây 2 động cơ bước
GND	Điện áp (-) âm của nguồn
VCC	Điện áp đầu vào (10-45V)

Công tắc điều khiển trình điều khiển động cơ bước TB6600

Các công tắc này được sử dụng để điều khiển độ phân giải microstep và giới hạn dòng điện của trình điều khiển .

Bạn có thể thay đổi độ phân giải microstep từ bước đầy đủ thành 1/16 bước bằng cách chuyển công tắc S1, S2 và S3.

Cài đặt vi bước cho driver

Bảng vi thiết lập vi bước được sử dụng để cài đặt chế độ vi bước cho động cơ bước. Chế độ vi bước xác định độ chính xác của chuyển động của động cơ bước. Số bước vi bước càng cao, thì chuyển động của động cơ bước càng chính xác.

Cách sử dụng bảng vi thiết lập vi bước:

1. Xác định số bước vi bước mỗi vòng của động cơ bước. Thông tin này thường được ghi trên nhãn động cơ bước hoặc trong tài liệu kỹ thuật của nhà sản xuất.
2. Xác định độ phân giải mong muốn cho chuyển động của động cơ bước.
3. Sử dụng bảng vi thiết lập vi bước để tìm chế độ vi bước phù hợp với số bước vi bước mỗi vòng và độ phân giải mong muốn.
4. Cài đặt chế độ vi bước đã chọn trên trình điều khiển động cơ bước.

Ví dụ:

Giả sử bạn có động cơ bước với 400 bước vi bước mỗi vòng và bạn muốn động cơ bước di chuyển với độ phân giải 0.45°. Theo bảng vi thiết lập vi bước, bạn nên chọn chế độ vi bước 1/4.

Bạn có thể điều chỉnh và hạn chế dòng điện bằng chiết áp.

Phần cứng cần thiết

• Arduino UNO R3
• Trình điều khiển động cơ bước TB6600 4.5A
• OK17STH47 Động Cơ Bước Nema17 42x42mm, 1.8°, 0.46N.cm
• Dây jumper đực sang đực

Giao tiếp trình điều khiển động cơ bước TB6600 với Arduino

Ghi chú

• Bạn có thể sử dụng đồng hồ vạn năng để tìm hai dây từ một cuộn dây.
• Vặn đồng hồ vạn năng sang thang đo ngắn mạch và thử nghiệm các dây dẫn theo cặp. Hai dây dẫn bị đoản mạch khi mắc vào đồng hồ vạn năng là hai phía của một cuộn dây.

Ví dụ 1: Động cơ quay thuận 3 vòng, dừng 1s sau đó quay nghịch 3 vòng, dừng 1s và lặp lại vô tận.

Bước 1: Kết nối mạch

ARDUINO	TB6600	STEP MOTOR
5V	5V
D9	CLK-
D10	CW-
D11	EN-
	A-, A+	Cặp cuộn dây 1 động cơ bước
	B-, B+	Cặp cuộn dây 2 động cơ bước
	GND (0V)
	+32V (Cấp nguồn 10~45 VDC)

Bước 2: Code

Tải code sau lên Arduino.

#define stepPin 9
#define dirPin 10
#define enPin 11
const int stepsPerRevolution = 200; // Số bước mỗi vòng (thường là 200 cho động cơ bước 1.8 độ)
void setup() {
  // Declare pins as output:
  pinMode(stepPin, OUTPUT);
  pinMode(dirPin, OUTPUT);
  pinMode(enPin, OUTPUT);
}
void loop() {
    runMotor(CW, 3, 500); //Quay thuận 3 vòng
    delay(1000);
    runMotor(CCW, 3, 500); //Quay nghịch 3 vòng
    delay(1000);
}
void runMotor(int dir, int numberOfRevolutions, int stepSpeed) {
  digitalWrite(enPin, HIGH);
  digitalWrite(dirPin, dir); // Enables the motor to move in a particular direction
  for (int x = 0; x < numberOfRevolutions * stepsPerRevolution; x++) {
    digitalWrite(stepPin, HIGH);
    delayMicroseconds(stepSpeed);
    digitalWrite(stepPin, LOW);
    delayMicroseconds(stepSpeed);
  }
  digitalWrite(enPin, LOW);
}
void runMotor(int dir , int stepSpeed) {
  digitalWrite(enPin, HIGH);
  digitalWrite(dirPin, dir); // Enables the motor to move in a particular direction
  digitalWrite(stepPin, HIGH);
  delayMicroseconds(stepSpeed);
  digitalWrite(stepPin, LOW);
  delayMicroseconds(stepSpeed);
  digitalWrite(enPin, LOW);
}

Ví dụ 2: Điều khiển động cơ bước bằng nút nhấn. Nhấn nút Key 1 động cơ quay thuận 3 vòng, dừng 1s sau đó quay nghịch 3 vòng. Nhấn nút Key 2 động cơ quay thuận, Nhấn nút Key 3 động cơ quay nghịch.

Bước 1: Kết nối mạch

ARDUINO	TB6600	STEP MOTOR	Keypad
5V	5V		VCC
GND			GND
A0			Key 1
A1			Key 2
A2			Key 3
A3			Key 4
D9	CLK-
D10	CW-
D11	EN-
	A-, A+	Cặp cuộn dây 1 động cơ bước
	B-, B+	Cặp cuộn dây 2 động cơ bước
	GND (0V)
	+32V (Cấp nguồn 10~45 VDC)

Bước 2: Code

Tải code sau lên Arduino.

#define stepPin 9
#define dirPin 10
#define enPin 11
#define CW LOW
#define CCW HIGH
#define btnStart A0
#define btnCW A1
#define btnCCW A2
#define btnStop A3
const int stepsPerRevolution = 200; // Số bước mỗi vòng (thường là 200 cho động cơ bước 1.8 độ)
void setup() {
  // Declare pins as output:
  Serial.begin(9600);
  pinMode(stepPin, OUTPUT);
  pinMode(dirPin, OUTPUT);
  pinMode(enPin, OUTPUT);
  pinMode(btnStart, INPUT_PULLUP);
  pinMode(btnCW, INPUT_PULLUP);
  pinMode(btnCCW, INPUT_PULLUP);
}
void loop() {
  if (digitalRead(btnStart) == LOW) {
    runMotor(CW, 3, 500); //Quay thuận 3 vòng
    delay(1000);
    runMotor(CCW, 3, 500); //Quay nghịch 3 vòng
    while (digitalRead(btnStart) == LOW);
  }
  if (digitalRead(btnCW) == LOW) {
    runMotor(CW, 500);
  }
  if (digitalRead(btnCCW) == LOW) {
    runMotor(CCW, 500);
  }
}
void runMotor(int dir, int numberOfRevolutions, int stepSpeed) {
  digitalWrite(enPin, HIGH);
  digitalWrite(dirPin, dir); // Enables the motor to move in a particular direction
  for (int x = 0; x < numberOfRevolutions * stepsPerRevolution; x++) {
    digitalWrite(stepPin, HIGH);
    delayMicroseconds(stepSpeed);
    digitalWrite(stepPin, LOW);
    delayMicroseconds(stepSpeed);
  }
  digitalWrite(enPin, LOW);
}
void runMotor(int dir , int stepSpeed) {
  digitalWrite(enPin, HIGH);
  digitalWrite(dirPin, dir); // Enables the motor to move in a particular direction
  digitalWrite(stepPin, HIGH);
  delayMicroseconds(stepSpeed);
  digitalWrite(stepPin, LOW);
  delayMicroseconds(stepSpeed);
  digitalWrite(enPin, LOW);
}

Video