Aprender

Un brazo robótico de cuatro servos en un controlador de servos PCA9685

Avanzado

O mira todas las lecciones.

  • 526componentes en el banco de trabajo
  • 46placas funcionando ahora
  • 1.00xtiempo real, en todas las placas
Arduino Uno: brazo robótico con un PCA9685en vivo0.000 s 0.00x
Haz clic para abrirlo en el editor
El ejemplo del brazo Pick and place en un ATmega328P simulado: cuatro servos, dos cables I2C.

El PCA9685 es la placa azul con dieciséis conectores de servo a lo largo de un borde. Él genera los pulsos de los servos por sí mismo, así que tu Arduino solo tiene que indicar a dónde debe ir cada servo. Solo necesita dos cables desde la placa, los pines I2C, ya sea que uses un servo o dieciséis. Por eso los kits de brazos robóticos y hexápodos lo usan.

El circuito de arriba es un Arduino Uno que controla un brazo robótico de escritorio de cuatro servos mediante un PCA9685. El brazo levanta un componente a la izquierda, gira, lo deja a la derecha y vuelve a casa, una y otra vez. Cada movimiento se imprime en el monitor serie. Se ejecuta en tu navegador con el sketch de abajo.

Lo que necesitas

  • Un Arduino Uno
  • Una placa controladora de servos PCA9685 de 16 canales
  • Up to sixteen hobby servos (four SG90s in a robot arm here)
  • Una fuente de 5 V aparte para los servos
  • Cables jumper

Cableado

Componente y pinVa aNota
PCA9685 SDAA4El pin de datos I2C del Uno
PCA9685 SCLA5El reloj I2C del Uno; la placa tiene sus propias pull-ups
PCA9685 VCC5 VAlimentación lógica solo para el chip
PCA9685 GNDGNDCompartida con el Uno y la alimentación de los servos
PCA9685 V+Fuente de 5 V aparteEnergía para los servos, no del Uno
Canal 0Servo de la baseGira todo el brazo
Canal 1Servo del hombroInclina el brazo superior
Canal 2Servo del codoInclina el antebrazo
Canal 3Servo de la garraAbre y cierra las mandíbulas

Dos fuentes de energía, una tierra

El PCA9685 tiene dos fuentes separadas. VCC alimenta el chip y viene del pin de 5 V del Uno. V+ alimenta los servos y debe venir de su propia fuente de 5 V. Los servos consumen mucha corriente cuando se mueven, mucho más de lo que el pin de 5 V de un Uno debería entregar. Todas las tierras se unen entre sí.

Esta es, por mucho, la mayor causa de problemas en proyectos reales. Un servo que tiembla, o un Uno que se reinicia cuando el brazo se mueve, casi siempre se debe a servos alimentados desde el propio 5 V de la placa.

El código: de ángulos a pulsos

El sketch usa la biblioteca Adafruit PWM Servo Driver, que viene integrada en Mokxi. pwm.begin() despierta el chip. pwm.setPWMFreq(50) ajusta la frecuencia de pulsos que esperan los servos: cincuenta veces por segundo.

Luego setAngle() convierte un ángulo en un ancho de pulso. El sketch usa la ventana de la biblioteca Servo de Arduino, 544 microsegundos para 0 grados y 2400 microsegundos para 180, así que map() convierte uno en el otro, y writeMicroseconds() lo envía a un canal.

glide() mueve las cuatro articulaciones a una nueva pose juntas, en 25 pasos pequeños separados por 30 ms. Así es como un brazo real evita dañar sus engranes y golpear lo que carga.

Configuración y una articulación, del ejemplo Brazo de pick and place
#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 y conteos

Muchos tutoriales usan pwm.setPWM(channel, 0, count) en lugar de writeMicroseconds(). El chip divide cada período en 4096 conteos. A 50 Hz, un conteo son unos 4.9 microsegundos, así que un pulso de servo de 544 a 2400 microsegundos son unos 111 a 492 conteos. Ambas llamadas funcionan aquí.

La línea del oscilador en el ejemplo de Adafruit

El sketch de ejemplo de Adafruit incluye pwm.setOscillatorFrequency(27000000). Esa línea ajusta la biblioteca a un chip real en particular, porque los chips reales se desvían unos puntos porcentuales de sus 25 MHz nominales.

El chip simulado corre exactamente a 25 MHz. Si copias esa línea en Mokxi, cada pulso sale unos 8 por ciento más corto de lo que pediste. Aquí déjala fuera. En tu propia placa, mide y ajústala si tus servos quedan un poco desviados.

Pruébalo en el editor

Cambia los ángulos del loop para enseñarle al brazo un movimiento nuevo. Cambia 25 pasos por 50 en glide() y cada movimiento será más suave y lento.

Compáralo con el proyecto Brazo robótico con joysticks. Ese maneja el mismo brazo desde cuatro pines del Uno con la biblioteca Servo y sin PCA9685. Cuatro servos caben en un Uno de cualquier forma; el PCA9685 es lo que te permite llegar a dieciséis con dos cables.

Observa el PCA9685 mientras corre. Debajo de cada canal, la placa muestra el ancho de pulso que está enviando, en microsegundos.

Errores comunes

Alimentar los servos desde el pin de 5 V del Uno. Dale a V+ su propia fuente y une las tierras.

Olvidar setPWMFreq(50). Los servos esperan un pulso cincuenta veces por segundo.

Límites de pulso que no coinciden con tu servo. Los servos varían: algunos quieren de 1000 a 2000 microsegundos, otros de 500 a 2500. Revisa el tuyo y ajusta aquí el min_pulse y el max_pulse del servo para que coincidan, o no alcanzarás todo el rango.

Dos placas en la misma dirección. Todo PCA9685 empieza en 0x40. Para conectar más en cadena, suelda los jumpers de dirección en las placas adicionales para que cada una tenga su propia dirección.

Abre este circuito en el editor. Arduino Uno: brazo robótico con un PCA9685, cableado como corre en la parte superior de esta página. Cambia un componente o un valor y ejecútalo de nuevo.

Abrir el circuito

Preguntas

¿Cuántos servos puede controlar un PCA9685?

Dieciséis por placa. Varias placas pueden compartir los mismos dos cables de I2C si cada una tiene su propia dirección, configurada con los jumpers de soldadura.

¿Qué pines usa un PCA9685 en un Arduino Uno?

SDA en A4 y SCL en A5, más 5 V y tierra para el chip. Los servos reciben su energía de V+.

¿Por qué tiemblan mis servos con un PCA9685?

La mayoría de las veces la fuente de los servos es muy débil o está compartida con el Arduino. Dale a V+ su propia fuente de 5 V que pueda con todos los servos moviéndose a la vez.

¿Qué no simula Mokxi en el PCA9685?

La variación de los osciladores reales, la entrada de reloj externo, las subdirecciones y la llamada de reinicio por software. El chip corre exactamente a 25 MHz.

Ármalo en la vida real

Abre el editor, cambia un valor y mira cómo cambia el número con él. Nada que instalar y sin necesidad de cuenta.