Aprender

Un robot seguidor de línea con Arduino, del sensor al volante

Intermedio

O mira todas las lecciones.

  • 526componentes en el banco de trabajo
  • 46placas funcionando ahora
  • 1.00xtiempo real, en todas las placas
Arduino Uno: un carrito seguidor de líneaen vivo0.000 s 0.00x
Haz clic para abrirlo en el editor
A 5-channel line sensor on A0 to A4 and two motors on a TB6612FNG, on a simulated ATmega328P. Drag the tape across under the sensor.

El seguidor de línea es el primer robot que arman la mayoría de los kits de auto robot. Una fila de sensores bajo la parte delantera mira al piso, el Arduino calcula dónde está una cinta negra, y frena una rueda y acelera la otra para mantener la cinta al centro. Es una lección pequeña y completa de sensar, decidir y manejar.

El circuito de arriba es un Uno con un sensor de línea de cinco canales en A0 a A4, un controlador de motores TB6612FNG, dos motores con caja de velocidades y un paquete de dos celdas 18650. El carrito no se mueve en la pantalla, así que el piso se mueve en su lugar: arrastra el deslizador del sensor para mover la cinta a la izquierda o a la derecha, y observa cómo cambian de velocidad las dos ruedas. Haz clic en la muestra de color para poner una barra negra a lo ancho de la pista, y el carrito se detiene en la meta.

Lo que necesitas

  • Un Arduino Uno
  • A 5-channel line tracking sensor board (five TCRT5000 sensors)
  • Un controlador de motores TB6612FNG
  • Dos motores con caja de velocidades de 6 V en un chasis de dos ruedas
  • Un paquete de baterías para los motores (aquí dos celdas 18650, 8.4 V cuando están llenas)
  • Cables puente y cinta aislante negra sobre un piso claro

Cableado

Componente y pinVa aNota
Del sensor S1 (izquierda) al S5 (derecha)A4, A3, A2, A1, A0Alto sobre la línea negra
VCC y GND del sensor5 V (IOREF) y GND
TB6612 PWMA, AIN1, AIN2Pines 5, 2, 4El motor izquierdo
TB6612 PWMB, BIN1, BIN2Pines 6, 7, 8El motor derecho
TB6612 STBYPin 9Un nivel bajo pone el controlador en reposo
TB6612 VCC5 VLa alimentación lógica
TB6612 VMBatería +La alimentación de los motores
Todas las tierrasGNDBatería, controlador y Uno unidos

Leer la línea con cinco sensores

Cada sensor es un LED infrarrojo y un sensor de luz apuntando hacia abajo. El piso blanco refleja la luz y la cinta negra la absorbe, y un comparador en la placa convierte eso en una señal digital simple: alto sobre la línea negra, bajo sobre el blanco. Así el sketch lee los cinco canales con digitalRead(), aunque estén conectados a los pines analógicos.

Los sensores están separados 15 mm. El sketch asigna a cada uno un lugar, desde -30 mm para S1 a la izquierda hasta +30 mm para S5 a la derecha, y promedia los lugares de los sensores que ven la cinta. Bajo el sensor central, la línea está en 0 mm. Entre S3 y S4, ambos la ven, y el promedio es 7 mm. Eso da una posición más fina que la separación de los sensores.

Dirección: P y D

La posición es el error: qué tan lejos está la línea del centro. Ambas ruedas arrancan con una velocidad base de 120 sobre 255. El sketch suma un giro a la rueda izquierda y se lo resta a la derecha. El giro es KP por el error más KD por cuánto cambió el error desde la vez anterior. KP atrae el carrito de vuelta hacia la línea; KD amortigua el balanceo para que no zigzaguee.

Con la línea bajo el sensor central, el monitor serie dice "line 0 mm left 120 right 120". Desliza la cinta a 15 mm a la derecha y se estabiliza en "line 15 mm left 165 right 75": la rueda izquierda más rápida, así que el carrito gira a la derecha, de vuelta sobre la línea. Deslízala bajo S1 y dice "line -30 mm left 30 right 180".

El bucle principal, del carrito seguidor de línea
void loop() {
  if (finished) return;

  int seen = 0;
  int sum = 0;
  for (int i = 0; i < 5; i++) {
    if (digitalRead(SENSORS[i]) == HIGH) {
      seen++;
      sum += (i - 2) * 15;
    }
  }

  if (seen == 5) {
    brake(leftMotor, rightMotor);
    finished = true;
    Serial.println("finish bar: stopped");
    return;
  }

  int left;
  int right;
  if (seen == 0) {
    // Lost it: turn toward where it was last.
    left = lastError >= 0 ? SEARCH : -SEARCH;
    right = -left;
    leftMotor.drive(left);
    rightMotor.drive(right);
    report("searching, last", lastError, left, right);
    delay(10);
    return;
  }

  int error = sum / seen;
  int turn = KP * error + KD * (error - lastError);
  lastError = error;
  left = clampSpeed(BASE + turn);
  right = clampSpeed(BASE - turn);
  leftMotor.drive(left);
  rightMotor.drive(right);
  report("line", error, left, right);
  delay(10);
}

Perder la línea y la barra de meta

En una curva cerrada la cinta puede escaparse del sensor exterior, y entonces ningún sensor ve nada. El sketch recuerda el último error y gira hacia él: una rueda adelante a 110, la otra atrás a 110, hasta que un sensor encuentre la cinta de nuevo. Arrastra la cinta fuera del borde izquierdo y el monitor serie dice "searching, last -30 mm left -110 right 110".

Los cinco sensores en negro al mismo tiempo significan una barra a lo ancho de la pista. El sketch llama brake() en ambos motores e imprime "finish bar: stopped".

Motores y alimentación

El TB6612FNG es un puente H para dos motores. Para cada uno, dos pines fijan la dirección y un pin PWM fija la velocidad, y STBY debe estar en alto o nada se mueve. La biblioteca SparkFun TB6612 lo resume: drive(150) hace girar un motor hacia adelante a 150, drive(-150) lo hace girar hacia atrás, y brake() lo detiene.

Dos celdas 18650 llenas dan 8.4 V y estos motores son de 6 V nominales, así que el sketch nunca pide más de 180 sobre 255, unos 5.9 V en promedio. En este circuito el Uno funciona con USB; en un carrito real el mismo paquete alimentaría el pin VIN del Uno a través de un interruptor.

Mokxi modela el controlador y los motores, pero no el carrito moviéndose por un piso, así que no hay inercia que lo saque de una curva ni agarre que perder. Eso es justo lo que tú ajustas con KP, KD y la velocidad base en una pista real.

Errores comunes

Girar hacia el lado equivocado. Con la línea a la derecha, la rueda izquierda debe girar más rápido. Si tu carrito se aleja de la línea, intercambia el más y el menos en las dos líneas de velocidad, o intercambia los cables de un motor.

Leer el sensor al revés. En esta placa alto significa negro. Algunas placas son al contrario; imprime primero las cinco lecturas y verifica.

Montar los sensores demasiado alto. Un TCRT5000 debe estar a unos pocos milímetros del piso. Pasado un centímetro aproximadamente ya no distingue el negro del blanco.

Olvidar STBY. Con STBY en bajo o sin conectar, el driver se duerme y los motores nunca giran.

No tener una tierra común entre la batería, el driver y el Uno.

Demasiada velocidad. Un carrito que se pasa de largo en cada curva necesita una velocidad base menor o más KD antes que un mejor sensor.

Abre este circuito en el editor. Arduino Uno: un carrito seguidor de línea, cableado como funciona al inicio de esta página. Cambia un componente o un valor y ejecútalo de nuevo.

Abrir el circuito

Preguntas

¿Cómo funciona un robot seguidor de línea?

Los sensores debajo del frente distinguen la cinta negra de un piso claro. El Arduino calcula qué tan lejos está la cinta del centro y frena la rueda del lado donde está la cinta, así el robot gira de vuelta sobre ella.

¿Cuántos sensores necesita un seguidor de línea?

Con dos se puede seguir una línea suave. Cinco, como aquí, dan una posición en lugar de solo izquierda o derecha, lo que permite un giro suave, y permiten que el robot vea una barra de meta cruzada en la pista.

¿Qué es el PID en un seguidor de línea?

Proporcional, integral y derivativo: tres formas de convertir el error en una corrección de dirección. Este robot usa P y D. El término P gira más fuerte cuanto más lejos está la línea; el término D amortigua el giro cuando el error ya está disminuyendo.

¿Puedo usar un L298N en lugar de un TB6612FNG?

Sí, el cableado y el código son casi iguales: dos pines de dirección y un pin PWM por motor. El L298N pierde alrededor de 2 voltios en sus transistores, así que los motores reciben menos de la batería. Mokxi tiene ambos drivers.

Á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.