Crea un robot para comer con Arduino Nano | Tornillo dorado

Código

• GoldScrew_EatingRobot.ino

GoldScrew_EatingRobot.ino Arduino

 / * * Robot come cartoncillo * Autor:GoldScrew * Correo electrónico:[email protected] * Descripción:Está usando HC-SR04 (Detecta comida por distancia <=5 cm) y Servidor (para abrir y cerrar la boca) * / #include  #define SERVO_PIN 9 // Establecer el pin 9 para el servo // Sensor ultrasónico HC-SR04const int trig =3; // trig de HC-SR04const int echo =2; // eco de HC-SR04 // ServoServo mouthServo; void setup () {// Conexión serial con baudrate 960 Serial.begin (9600); // Enviar señal con TRIG pinMode (trig, OUTPUT); // Recibir señal con ECHO pinMode (echo, INPUT); // Servidor de boca mouthServo.attach (SERVO_PIN); mouthServo.write (90); } bucle void () {/ * Duración * / larga duración sin firmar; int distancia; // Distancia / * Enviar señal desde el pin TRIG * / digitalWrite (trig, 0); // Detener el pin de disparo delayMicroseconds (2); // Retraso 2 microsegundos digitalWrite (trig, 1); // Enviar señal desde el pin TRIG delayMicroseconds (10); // Retraso 10 microsegundos digitalWrite (trig, 0); // Detener el pin de activación / * Medir el ancho de pulso ALTO en el pin ECHO * / duration =pulseIn (echo, HIGH); // Calcula la distancia distancia =int (duración / 2 / 29.412); if (distancia <=5) {// Distancia de impresión Serial.println ("la distancia es inferior a 5 cm"); // Iniciar boca abierta mouthServo.write (0); // Retraso de retardo (1200); } else {// Distancia de impresión Serial.println ("la distancia es más de 5 cm"); // Cerrar la boca mouthServo.write (90); } // Delay delay (200);} 

Esquemas