Um TB6612FNG num Arduino: dois motores, nos dois sentidos
Intermediário
- 526componentes na bancada
- 46placas rodando agora
- 1.00xtempo real, em todas as placas
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.
O circuito acima é um Uno acionando dois motores com caixa de redução através de um TB6612FNG, alimentado por um conjunto de quatro pilhas AA. Ele roda um laço de movimentos: para frente em velocidade máxima, para frente em meia velocidade, um giro no próprio eixo, ré, frenagem e um movimento livre em standby, e imprime cada um. Aperte Rodar e observe os motores e o conjunto de pilhas.
O que você precisa
- Um Arduino Uno (um Nano funciona do mesmo jeito)
- Uma placa de expansão TB6612FNG
- Dois pequenos motores CC com caixa de redução
- Um conjunto de quatro pilhas AA para os motores
- Jumpers
Ligação
| Componente e pino | Vai para | Nota |
|---|---|---|
| PWMA | Pino 5 | Velocidade do motor esquerdo, um pino PWM |
| AIN1 | Pino 2 | Direção do motor esquerdo |
| AIN2 | Pino 4 | Direção do motor esquerdo |
| PWMB | Pino 6 | Velocidade do motor direito, um pino PWM |
| BIN1 | Pino 7 | Direção do motor direito |
| BIN2 | Pino 8 | Direção do motor direito |
| STBY | Pino 9 | Deve estar em HIGH ou o driver não faz nada |
| VCC | 5 V | O fornecimento de lógica |
| VM | + do conjunto de pilhas | A alimentação dos motores, de 2,5 a 13,5 V |
| GND | GND e - do conjunto de pilhas | Um único terra para ambos |
| AO1, AO2 | Motor esquerdo | |
| BO1, BO2 | Motor direito |
A ligação, pino por pino
Cada motor precisa de três pinos. Dois pinos de direção escolhem o sentido de giro e um pino PWM define a velocidade. Com dois motores são seis pinos, mais o STBY, que desperta o chip inteiro. Esta versão usa os pinos 2, 4 e 5 para o motor esquerdo, 7, 8 e 6 para o direito, e o pino 9 para o STBY, igual ao kit da SparkFun.
Os pinos PWM precisam ser pinos que suportam analogWrite(). Em um Uno ou um Nano, são 3, 5, 6, 9, 10 e 11. Um Nano tem o mesmo chip e os mesmos números de pinos que um Uno, então esta ligação e este sketch funcionam em um Nano sem mudanças.
Há duas alimentações. VCC é a lógica do chip, vinda dos 5 V do Arduino. VM é a energia dos motores, vinda do conjunto de pilhas. Os dois terras devem ser ligados entre si, ou o driver não consegue entender o que os pinos do Arduino significam.
A biblioteca SparkFun TB6612FNG
SparkFun_TB6612.h, disponível no Gerenciador de Bibliotecas como "SparkFun TB6612FNG", transforma cada motor em um objeto. Você informa os dois pinos de direção, o pino PWM, um offset de 1 ou -1 e o pino STBY. drive() recebe uma velocidade de -255 a 255, e o sinal é a direção. brake() para um motor bruscamente e standby() deixa os dois deslizarem.
forward(), back(), left() e brake() controlam os dois motores de uma vez. left() gira um motor para frente e o outro para trás, o que faz o robô girar no próprio eixo. O offset serve para um motor ligado ao contrário: defina -1 em vez de trocar os fios.
#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);
}O que acontece quando você roda
O monitor serial imprime cada movimento ao começar: "drive: forward, full speed", depois "drive: spin left on the spot", "drive: reverse", "drive: brake" e "drive: standby: both motors coast". Em velocidade máxima, os dois motores estabilizam em cerca de 200 rpm. No giro, um gira para frente e o outro para trás.
Observe o conjunto de pilhas. Com nada rodando, ele mostra 6,4 V, quatro pilhas novas. Com os dois motores em velocidade máxima, ele cai para cerca de 6,16 V, porque as pilhas têm alguma resistência própria. Conjuntos reais fazem o mesmo, e um robô que reinicia quando os motores ligam costuma ser um conjunto caindo demais.
O próprio driver mostra o modo de cada canal na sua frente: off, CW, CCW ou brake.
Frear ou deslizar
Aqui o TB6612FNG se diferencia da maioria dos drivers. Quando seu pino PWM está em nível baixo, ele curto-circuita o motor através da ponte, o que é uma frenagem, não um deslizamento. Então em meia velocidade o motor é acionado e freado alternadamente, e desacelera com firmeza em vez de deslizar.
Com os dois pinos de direção em nível baixo, as saídas desligam e o motor desliza até parar. STBY em nível baixo faz o mesmo com os dois motores de uma vez. brake() é a parada brusca e standby() é a suave.
Você não precisa da biblioteca para usar esses modos. Coloque STBY em HIGH uma vez em setup(). Depois, para um motor, AIN1 em HIGH e AIN2 em LOW giram para um lado, AIN1 em LOW e AIN2 em HIGH para o outro, e analogWrite() em PWMA define a velocidade. Os dois pinos de direção em HIGH é frenagem, e ambos em LOW é deslizamento. Essa é toda a tabela verdade, e é tudo o que a biblioteca faz por você.
Erros comuns
STBY sem ligação. Cada entrada tem um pull-down interno, então um STBY desconectado lê como baixo e o chip não faz nada. Tire o fio do STBY no circuito aqui e os dois motores ficam em 0 rpm enquanto o sketch imprime os movimentos como se estivesse tudo bem.
Rodar os motores a partir dos 5 V do Arduino. Motores são ruidosos e puxam mais do que a placa pode fornecer. Dê ao VM uma alimentação própria.
Nenhum terra compartilhado entre o Arduino e a alimentação dos motores.
PWMA ou PWMB em um pino que não faz PWM, então o motor só roda em velocidade máxima ou nada.
Esperar que ele deslize entre pulsos PWM. Neste chip, PWM em nível baixo freia.
Abra este circuito no editor. Arduino Uno: dois motores em um TB6612FNG, ligados como no circuito no topo desta página. Mude um componente ou um valor e rode de novo.
Abrir o circuitoPerguntas
Como faço para ligar um TB6612FNG a um Arduino?
PWMA, AIN1 e AIN2 para um motor, PWMB, BIN1 e BIN2 para o outro, STBY em um pino que você coloca em HIGH, VCC no 5 V, VM na bateria dos motores, e todos os GND juntos. Esta página usa os pinos 5, 2, 4, 6, 7, 8 e 9.
Qual biblioteca funciona com o TB6612FNG?
SparkFun TB6612FNG (SparkFun_TB6612.h). Você também pode controlá-lo com digitalWrite() e analogWrite(), sem biblioteca nenhuma.
O TB6612FNG funciona com um Arduino Nano?
Sim. O Nano tem os mesmos números de pinos e os mesmos pinos PWM que o Uno, então a mesma ligação e o mesmo sketch funcionam.
Por que meus motores não giram com um TB6612FNG?
Verifique o STBY primeiro. Ele precisa estar em HIGH; se não estiver ligado, o chip fica desligado. Depois verifique se o VM tem alimentação e se os terras estão conectados.
Continuar
De onde vêm as informações desta página
Monte isto de verdade
Abra o editor, mude um valor e veja o número mudar junto. Nada para instalar, e não precisa de conta.