Um braço robótico de quatro servos num driver de servo PCA9685
Avançado
- 526componentes na bancada
- 46placas rodando agora
- 1.00xtempo real, em todas as placas
O PCA9685 é a placa azul com dezesseis conectores de servo ao longo de uma borda. Ele mesmo gera os pulsos dos servos, então seu Arduino só precisa dizer para onde cada servo deve ir. Precisa de apenas dois fios da placa, os pinos I2C, seja para um servo ou para dezesseis. É por isso que kits de braço robótico e hexápode o usam.
O circuito acima é um Arduino Uno controlando um braço robótico de mesa com quatro servos através de um PCA9685. O braço pega um componente à esquerda, gira, coloca-o à direita e volta ao início, repetidamente. Cada movimento é impresso no monitor serial. Ele roda no seu navegador com o sketch abaixo.
O que você precisa
- Um Arduino Uno
- Uma placa driver de servo PCA9685 de 16 canais
- Up to sixteen hobby servos (four SG90s in a robot arm here)
- Uma fonte de 5 V separada para os servos
- Jumpers
Ligação
| Componente e pino | Vai para | Nota |
|---|---|---|
| PCA9685 SDA | A4 | O pino de dados do I2C do Uno |
| PCA9685 SCL | A5 | O clock I2C do Uno; a placa tem seus próprios pull-ups |
| PCA9685 VCC | 5 V | Alimentação lógica só para o chip |
| PCA9685 GND | GND | Compartilhado com o Uno e a fonte dos servos |
| PCA9685 V+ | Fonte separada de 5 V | Alimentação para os servos, não vem do Uno |
| Canal 0 | Servo da base | Gira o braço inteiro |
| Canal 1 | Servo do ombro | Inclina o braço superior |
| Canal 2 | Servo do cotovelo | Inclina o antebraço |
| Canal 3 | Servo da garra | Abre e fecha as garras |
Duas fontes de alimentação, um terra
O PCA9685 tem duas fontes separadas. VCC alimenta o chip e vem do pino de 5 V do Uno. V+ alimenta os servos e deve vir de uma fonte de 5 V própria. Servos consomem muita corrente quando se movem, bem mais do que o pino de 5 V do Uno deveria fornecer. Todos os terras se conectam juntos.
Essa é a maior causa de problemas em montagens reais. Um servo que treme, ou um Uno que reinicia quando o braço se move, quase sempre é sinal de servos rodando a partir do próprio 5 V da placa.
O código: de ângulos para pulsos
O sketch usa a biblioteca Adafruit PWM Servo Driver, que já vem incluída no Mokxi. pwm.begin() acorda o chip. pwm.setPWMFreq(50) define a taxa de pulsos que os servos esperam: cinquenta vezes por segundo.
Depois, setAngle() transforma um ângulo em uma largura de pulso. O sketch usa a janela da biblioteca Servo do Arduino, 544 microssegundos para 0 graus e 2400 microssegundos para 180, então map() converte um no outro, e writeMicroseconds() envia para um canal.
glide() move as quatro juntas para uma nova pose juntas, em 25 passos pequenos de 30 ms cada. É assim que um braço real evita forçar as engrenagens e balançar o que carrega.
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
const int MIN_US = 544;
const int MAX_US = 2400;
void setAngle(int channel, int degrees) {
pwm.writeMicroseconds(channel, map(degrees, 0, 180, MIN_US, MAX_US));
}
void setup() {
Serial.begin(115200);
pwm.begin();
pwm.setPWMFreq(50);
setAngle(0, 90); // the base to the middle
}setPWM e contagens
Muitos tutoriais usam pwm.setPWM(channel, 0, count) em vez de writeMicroseconds(). O chip divide cada período em 4096 contagens. A 50 Hz, uma contagem tem cerca de 4,9 microssegundos, então um pulso de servo de 544 a 2400 microssegundos vai de cerca de 111 a 492 contagens. As duas chamadas funcionam aqui.
A linha do oscilador no exemplo da Adafruit
O sketch de exemplo da Adafruit inclui pwm.setOscillatorFrequency(27000000). Essa linha ajusta a biblioteca para um chip real específico, porque chips reais funcionam alguns por cento fora dos 25 MHz nominais.
O chip simulado roda a exatamente 25 MHz. Se copiar essa linha no Mokxi, cada pulso sai cerca de 8 por cento mais curto do que o pedido. Aqui, deixe essa linha de fora. Na sua própria placa, meça e ajuste se seus servos ficarem um pouco fora do ponto.
Experimente no editor
Mude os ângulos no loop para ensinar um movimento novo ao braço. Mude 25 passos para 50 em glide() e todo movimento fica mais suave e mais lento.
Compare com o projeto Robot arm with joysticks. Ele aciona o mesmo braço a partir de quatro pinos do Uno com a biblioteca Servo e sem PCA9685. Quatro servos cabem em um Uno dos dois jeitos; o PCA9685 é o que permite chegar a dezesseis com dois fios.
Observe o PCA9685 enquanto ele roda. Sob cada canal, a placa mostra a largura de pulso que está enviando, em microssegundos.
Erros comuns
Alimentar servos a partir do pino de 5 V do Uno. Dê a V+ uma fonte própria e una os terras.
Esquecer o setPWMFreq(50). Servos esperam um pulso cinquenta vezes por segundo.
Limites de pulso que não combinam com o seu servo. Servos variam: alguns querem 1000 a 2000 microssegundos, outros 500 a 2500. Verifique o seu e defina aqui o min_pulse e o max_pulse do servo para combinar, ou você não alcançará toda a faixa.
Duas placas no mesmo endereço. Todo PCA9685 começa em 0x40. Para encadear mais, solde os jumpers de endereço nas placas extras para que cada uma tenha seu próprio endereço.
Abra este circuito no editor. Arduino Uno: braço de robô em um PCA9685, ligado como aparece no topo desta página. Mude um componente ou um valor e rode de novo.
Abrir o circuitoPerguntas
Quantos servos um PCA9685 pode controlar?
Dezesseis por placa. As placas podem compartilhar os mesmos dois fios I2C se cada uma tiver seu próprio endereço, definido com os jumpers de solda.
Quais pinos um PCA9685 usa em um Arduino Uno?
SDA no A4 e SCL no A5, mais 5 V e terra para o chip. Os servos recebem energia de V+.
Por que meus servos tremem em um PCA9685?
Na maioria das vezes a fonte dos servos é fraca demais ou compartilhada com o Arduino. Dê a V+ uma fonte de 5 V própria que aguente todos os servos se movendo ao mesmo tempo.
O que o Mokxi não simula no PCA9685?
A variação dos osciladores reais, a entrada de clock externo, os sub-endereços e a chamada de reset por software. O chip roda a exatamente 25 MHz.
Continuar
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.