Un brazo robótico de cuatro servos en un controlador de servos PCA9685
Avanzado
- 526componentes en el banco de trabajo
- 46placas funcionando ahora
- 1.00xtiempo real, en todas las placas
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 pin | Va a | Nota |
|---|---|---|
| PCA9685 SDA | A4 | El pin de datos I2C del Uno |
| PCA9685 SCL | A5 | El reloj I2C del Uno; la placa tiene sus propias pull-ups |
| PCA9685 VCC | 5 V | Alimentación lógica solo para el chip |
| PCA9685 GND | GND | Compartida con el Uno y la alimentación de los servos |
| PCA9685 V+ | Fuente de 5 V aparte | Energía para los servos, no del Uno |
| Canal 0 | Servo de la base | Gira todo el brazo |
| Canal 1 | Servo del hombro | Inclina el brazo superior |
| Canal 2 | Servo del codo | Inclina el antebrazo |
| Canal 3 | Servo de la garra | Abre 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.
#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 circuitoPreguntas
¿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.
Sigue así
Á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.