TB6612FNG trên Arduino: hai động cơ, cả hai chiều
Trung bình
Hoặc xem mọi bài học.
- 526linh kiện trên bàn làm mạch
- 46bo mạch đang chạy
- 1.00xthời gian thực, trên mọi bo mạch
The TB6612FNG is a dual motor driver: two H bridges on one small board, enough for the two wheels of a robot. It is the driver in the SparkFun Inventor’s Kit, and it beats the old L298N and L293D at one thing that matters on batteries. Its MOSFET bridges keep a fraction of a volt for themselves, where the older chips lose two volts or more.
Mạch ở trên là một Uno điều khiển hai động cơ có hộp số qua TB6612FNG, cấp nguồn bằng bộ bốn pin AA. Nó chạy một vòng lặp các thao tác: tiến hết tốc lực, tiến nửa tốc lực, quay tại chỗ, lùi, phanh, và trôi ở chế độ chờ, và in ra từng thao tác. Nhấn Chạy và quan sát các động cơ và bộ pin.
Những gì bạn cần
- Một Arduino Uno (Nano cũng dùng được tương tự)
- Một breakout TB6612FNG
- Hai động cơ DC hộp số nhỏ
- Một bộ bốn pin AA cho các động cơ
- Dây cắm
Đi dây
| Linh kiện và chân | Nối tới | Ghi chú |
|---|---|---|
| PWMA | Chân 5 | Tốc độ động cơ trái, một chân PWM |
| AIN1 | Chân 2 | Chiều quay động cơ trái |
| AIN2 | Chân 4 | Chiều quay động cơ trái |
| PWMB | Chân 6 | Tốc độ động cơ phải, một chân PWM |
| BIN1 | Chân 7 | Chiều quay động cơ phải |
| BIN2 | Chân 8 | Chiều quay động cơ phải |
| STBY | Chân 9 | Phải ở mức HIGH, nếu không driver sẽ không làm gì cả |
| VCC | 5 V | Nguồn cấp cho phần logic |
| VM | Cực dương của pin | Nguồn cấp cho động cơ, từ 2,5 đến 13,5 V |
| GND | GND và cực âm của pin | Một chân GND chung cho cả hai |
| AO1, AO2 | Động cơ trái | |
| BO1, BO2 | Động cơ phải |
Cách nối dây, từng chân một
Mỗi động cơ cần ba chân. Hai chân chiều quay chọn hướng quay, và một chân PWM đặt tốc độ. Với hai động cơ là sáu chân, cộng thêm STBY để đánh thức cả con chip. Mạch này dùng chân 2, 4 và 5 cho động cơ trái, chân 7, 8 và 6 cho động cơ phải, và chân 9 cho STBY, giống hệt bộ kit của SparkFun.
Các chân PWM phải là chân dùng được analogWrite(). Trên Uno hoặc Nano đó là các chân 3, 5, 6, 9, 10 và 11. Nano dùng cùng chip và cùng số chân với Uno, nên cách nối dây và sketch này chạy trên Nano mà không cần thay đổi gì.
Có hai nguồn cấp. VCC là phần logic của chip, lấy từ 5 V của Arduino. VM là nguồn cho động cơ, lấy từ pin. Hai chân GND phải nối chung với nhau, nếu không driver không thể hiểu tín hiệu trên các chân của Arduino.
Thư viện SparkFun TB6612FNG
SparkFun_TB6612.h, lấy từ Library Manager với tên "SparkFun TB6612FNG", biến mỗi động cơ thành một đối tượng. Bạn đưa vào hai chân chiều quay, chân PWM, một offset bằng 1 hoặc -1, và chân STBY. drive() nhận tốc độ từ -255 đến 255, và dấu là chiều quay. brake() dừng động cơ ngay lập tức và standby() cho cả hai động cơ tự do trượt.
forward(), back(), left() và brake() điều khiển cả hai động cơ cùng lúc. left() cho một động cơ quay tới và động cơ kia quay lùi, khiến robot xoay tại chỗ. Offset dành cho động cơ bị nối ngược chiều: đặt thành -1 thay vì đổi dây cho nhau.
#include <SparkFun_TB6612.h>
const int AIN1 = 2;
const int AIN2 = 4;
const int PWMA = 5;
const int BIN1 = 7;
const int BIN2 = 8;
const int PWMB = 6;
const int STBY = 9;
const int offsetA = 1;
const int offsetB = 1;
Motor leftMotor = Motor(AIN1, AIN2, PWMA, offsetA, STBY);
Motor rightMotor = Motor(BIN1, BIN2, PWMB, offsetB, STBY);
void loop() {
say("forward, full speed");
forward(leftMotor, rightMotor, 255);
delay(1500);
say("spin left on the spot");
left(leftMotor, rightMotor, 255);
delay(1200);
say("reverse");
back(leftMotor, rightMotor, 200);
delay(1500);
say("brake");
brake(leftMotor, rightMotor);
delay(1000);
say("standby: both motors coast");
leftMotor.standby();
delay(1500);
}Chuyện gì xảy ra khi bạn chạy nó
Serial Monitor in ra từng bước đi khi bắt đầu: "drive: forward, full speed", rồi "drive: spin left on the spot", "drive: reverse", "drive: brake" và "drive: standby: both motors coast". Ở tốc độ tối đa cả hai động cơ ổn định ở khoảng 200 vòng/phút. Khi xoay, một động cơ quay tới và động cơ kia quay lùi.
Hãy để mắt đến pin. Khi chưa chạy gì, nó hiển thị 6,4 V, bốn viên pin mới. Khi cả hai động cơ chạy hết tốc lực, điện áp tụt xuống còn khoảng 6,16 V, vì bản thân các viên pin cũng có điện trở. Pin thật cũng vậy, và một robot bị reset khi động cơ khởi động thường là do pin tụt áp quá nhiều.
Bản thân driver hiển thị chế độ của từng kênh ngay trên mặt nó: off, CW, CCW hoặc brake.
Phanh hay trượt tự do
Ở điểm này TB6612FNG khác với đa số các driver. Khi chân PWM ở mức thấp, nó nối ngắn động cơ qua cầu, đó là phanh chứ không phải trượt tự do. Nên ở nửa tốc độ, động cơ lúc thì được kéo, lúc thì bị phanh, và nó giảm tốc dứt khoát thay vì trôi dần.
Khi cả hai chân chiều quay ở mức thấp, các ngõ ra tắt và động cơ trượt dần rồi dừng. STBY ở mức thấp làm điều tương tự với cả hai động cơ cùng lúc. brake() là phanh gấp, còn standby() là dừng nhẹ nhàng.
Bạn không cần thư viện để dùng các chế độ này. Đặt STBY HIGH một lần trong setup(). Rồi với một động cơ, AIN1 HIGH và AIN2 LOW cho nó quay một chiều, AIN1 LOW và AIN2 HIGH cho quay chiều kia, và analogWrite() trên PWMA đặt tốc độ. Cả hai chân chiều quay HIGH là phanh, cả hai LOW là trượt tự do. Đó là toàn bộ bảng chân trị, và cũng là tất cả những gì thư viện làm giúp bạn.
Những lỗi thường gặp
STBY chưa được nối dây. Mỗi ngõ vào đều có điện trở kéo xuống bên trong, nên STBY không nối sẽ đọc mức thấp và chip không làm gì cả. Rút dây STBY khỏi mạch ở đây thì cả hai động cơ đứng yên ở 0 vòng/phút trong khi sketch vẫn in các bước đi như thể chẳng có gì sai.
Chạy động cơ từ 5 V của Arduino. Động cơ gây nhiễu và dòng điện lớn hơn mức bo mạch cấp được. Hãy cấp nguồn riêng cho VM.
Không có chân GND chung giữa Arduino và nguồn động cơ.
PWMA hoặc PWMB nối vào chân không có PWM, nên động cơ chỉ chạy hết tốc lực hoặc không chạy gì.
Mong nó trượt tự do giữa các xung PWM. Trên chip này, PWM mức thấp là phanh.
Mở mạch này trong trình soạn thảo. Arduino Uno: hai động cơ trên TB6612FNG, nối dây như mạch đang chạy ở đầu trang này. Thay một linh kiện hoặc một giá trị rồi chạy lại.
Mở mạchCâu hỏi
Làm thế nào nối TB6612FNG với Arduino?
PWMA, AIN1 và AIN2 cho một động cơ, PWMB, BIN1 và BIN2 cho động cơ kia, STBY vào một chân mà bạn đặt HIGH, VCC vào 5 V, VM vào pin của động cơ, và mọi GND nối chung. Trang này dùng chân 5, 2, 4, 6, 7, 8 và 9.
Thư viện nào dùng được với TB6612FNG?
SparkFun TB6612FNG (SparkFun_TB6612.h). Bạn cũng có thể điều khiển bằng digitalWrite() và analogWrite() mà không cần thư viện nào.
TB6612FNG có chạy được với Arduino Nano không?
Có. Nano có cùng số chân và các chân PWM như Uno, nên cùng cách nối dây và sketch vẫn chạy tốt.
Sao động cơ của tôi không quay khi dùng TB6612FNG?
Kiểm tra STBY trước tiên. Nó phải ở mức HIGH, và nếu chưa được nối thì chip sẽ tắt. Sau đó kiểm tra xem VM có điện và các chân GND đã nối chung với nhau chưa.
Tiếp tục nào
Thông tin trên trang này lấy từ đâu
Lắp mạch này ngoài đời
Mở trình soạn thảo, đổi một giá trị và xem con số thay đổi theo. Không cần cài gì, không cần tài khoản.