Belajar

TB6612FNG di Arduino: dua motor, dua arah

Menengah

Atau lihat semua pelajaran.

  • 526komponen di meja kerja
  • 46board sedang berjalan
  • 1.00xwaktu nyata, di semua board
Arduino Uno: dua motor di TB6612FNGlive0.000 s 0.00x
Klik untuk membukanya di editor
Maju, berputar, mundur, rem dan bebas, dengan paket empat baterai AA, di ATmega328P simulasi.

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.

Rangkaian di atas adalah Uno yang menggerakkan dua motor gearbox lewat TB6612FNG, dengan paket empat baterai AA. Ia menjalankan rangkaian gerakan: maju kecepatan penuh, maju setengah kecepatan, berputar di tempat, mundur, rem, dan bebas dalam mode standby, dan mencetak setiap gerakan. Tekan Jalankan dan perhatikan motor serta paket baterainya.

Yang kamu butuhkan

  • Arduino Uno (Nano juga bisa dipakai sama)
  • Sebuah breakout TB6612FNG
  • Dua motor DC gearbox kecil
  • Paket empat baterai AA untuk motor
  • Kabel jumper

Pengkabelan

Komponen dan pinDisambung keCatatan
PWMAPin 5Kecepatan motor kiri, pin PWM
AIN1Pin 2Arah motor kiri
AIN2Pin 4Arah motor kiri
PWMBPin 6Kecepatan motor kanan, sebuah pin PWM
BIN1Pin 7Arah motor kanan
BIN2Pin 8Arah motor kanan
STBYPin 9Harus HIGH atau driver tidak melakukan apa pun
VCC5 VCatu daya logika
VMBaterai +Catu daya motor, 2,5 sampai 13,5 V
GNDGND dan baterai -Satu ground untuk keduanya
AO1, AO2Motor kiri
BO1, BO2Motor kanan

Sambungannya, pin demi pin

Setiap motor butuh tiga pin. Dua pin arah menentukan arah putarnya, dan satu pin PWM mengatur kecepatannya. Dengan dua motor berarti enam pin, ditambah STBY yang membangunkan seluruh chip. Build ini memakai pin 2, 4 dan 5 untuk motor kiri, 7, 8 dan 6 untuk motor kanan, dan pin 9 untuk STBY, sama seperti kit SparkFun.

Pin PWM harus pin yang bisa menjalankan analogWrite(). Di Uno atau Nano pin tersebut adalah 3, 5, 6, 9, 10 dan 11. Nano punya chip yang sama dan nomor pin yang sama seperti Uno, jadi kabel dan sketch ini bisa dipakai di Nano tanpa perubahan.

Ada dua catu daya. VCC untuk logika chip, dari 5 V Arduino. VM untuk tenaga motor, dari baterai. Kedua ground harus disatukan, atau driver tidak bisa tahu apa maksud pin Arduino.

Library SparkFun TB6612FNG

SparkFun_TB6612.h, dari Library Manager dengan nama "SparkFun TB6612FNG", mengubah tiap motor menjadi sebuah objek. Kamu memberinya dua pin arah, pin PWM, offset 1 atau -1, dan pin STBY. drive() menerima kecepatan dari -255 sampai 255, dan tandanya menunjukkan arah. brake() menghentikan motor dengan cepat dan standby() membuat keduanya meluncur bebas.

forward(), back(), left() dan brake() menggerakkan kedua motor sekaligus. left() memutar satu motor maju dan satu lagi mundur, sehingga robot berputar di tempat. Offset dipakai untuk motor yang kabelnya terpasang terbalik: set ke -1 saja tanpa perlu menukar kabel.

Dari sketch penggerak robot TB6612
#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);
}

Apa yang terjadi saat kamu menjalankannya

Serial Monitor mencetak setiap gerakan saat dimulai: "drive: forward, full speed", lalu "drive: spin left on the spot", "drive: reverse", "drive: brake" dan "drive: standby: both motors coast". Pada kecepatan penuh kedua motor stabil di sekitar 200 rpm. Saat berputar, satu bergerak maju dan yang lain mundur.

Perhatikan baterai. Saat tidak ada yang berjalan, baterai menunjukkan 6,4 V, empat sel baru. Dengan kedua motor pada kecepatan penuh, tegangannya turun ke sekitar 6,16 V karena sel memiliki hambatan sendiri. Baterai sungguhan juga begitu, dan robot yang mereset saat motornya menyala biasanya karena baterainya turun terlalu jauh.

Driver itu sendiri menampilkan mode tiap channel di badannya: off, CW, CCW atau brake.

Brake atau coast

Di sini TB6612FNG berbeda dari kebanyakan driver. Saat pin PWM-nya low, driver mem-short motor melalui bridge, itu brake, bukan coast. Jadi pada setengah kecepatan motor didorong dan di-brake bergantian, dan melambat dengan pasti alih-alih meluncur pelan.

Dengan kedua pin arah low, output mati dan motor coast sampai berhenti. STBY low melakukan hal yang sama untuk kedua motor sekaligus. brake() adalah berhenti keras, dan standby() adalah yang lembut.

Kamu tidak perlu library untuk memakai mode ini. Set STBY HIGH sekali di setup(). Lalu, untuk satu motor, AIN1 HIGH dan AIN2 LOW memutarnya satu arah, AIN1 LOW dan AIN2 HIGH memutarnya arah lain, dan analogWrite() di PWMA mengatur kecepatannya. Kedua pin arah HIGH adalah brake, dan kedua LOW adalah coast. Itulah seluruh tabel kebenarannya, dan itulah semua yang library lakukan untukmu.

Kesalahan umum

STBY tidak disambungkan kabelnya. Setiap input punya pull-down di dalamnya, jadi STBY yang tidak disambung terbaca low dan chip tidak melakukan apa pun. Cabut kabel STBY di rangkaian di sini dan kedua motor diam di 0 rpm sementara sketch mencetak gerakannya seolah tidak ada yang salah.

Menjalankan motor dari 5 V Arduino. Motor berisik dan menarik arus lebih dari yang bisa diberikan board. Beri VM catu daya sendiri.

Tidak ada ground bersama antara Arduino dan catu daya motor.

PWMA atau PWMB di pin yang tidak bisa PWM, jadi motor hanya jalan di kecepatan penuh atau tidak sama sekali.

Mengira motor coast di antara pulsa PWM. Di chip ini PWM low berarti brake.

Buka rangkaian ini di editor. Arduino Uno: dua motor di TB6612FNG, dengan kabel seperti yang dijalankan di bagian atas halaman ini. Ubah komponen atau nilai lalu jalankan lagi.

Buka rangkaian ini

Pertanyaan

Bagaimana cara menyambungkan TB6612FNG ke Arduino?

PWMA, AIN1 dan AIN2 untuk satu motor, PWMB, BIN1 dan BIN2 untuk yang lain, STBY ke pin yang kamu set HIGH, VCC ke 5 V, VM ke baterai motor, dan semua GND disatukan. Halaman ini memakai pin 5, 2, 4, 6, 7, 8 dan 9.

Library mana yang cocok dengan TB6612FNG?

SparkFun TB6612FNG (SparkFun_TB6612.h). Kamu juga bisa menggerakkannya dengan digitalWrite() dan analogWrite() tanpa library sama sekali.

Apakah TB6612FNG bisa dipakai dengan Arduino Nano?

Bisa. Nano punya nomor pin dan pin PWM yang sama seperti Uno, jadi kabel dan sketch yang sama bisa dipakai.

Kenapa motorku tidak berputar dengan TB6612FNG?

Cek STBY dulu. Pin itu harus HIGH, dan jika tidak disambungkan kabel chip tetap mati. Lalu cek bahwa VM punya daya dan bahwa groundnya disatukan.

Rakit versi nyatanya

Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.