Membuat Robot Makan Dengan Arduino Nano | Sekrup Emas

Kode

• GoldScrew_EatingRobot.ino

GoldScrew_EatingRobot.inoArduino

/* * Robot pemakan karton * Penulis:GoldScrew * Email:[email protected] * Deskripsi:Menggunakan HC-SR04 (Mendeteksi makanan dengan jarak <=5 cm) dan Server (untuk membuka dan menutup mulut) * / #include  #define SERVO_PIN 9 // Setel pin 9 untuk servo// HC-SR04 sensor ultrasonikconst int trigonometri =3; // trigonometri dari HC-SR04const int echo =2; // echo HC-SR04// ServoServo mouthServo;void setup(){ // Koneksi serial dengan baudrate 960 Serial.begin(9600); // Kirim sinyal dengan TRIG pinMode(trig, OUTPUT); // Terima sinyal dengan ECHO pinMode(echo, INPUT); // Mulut Server mulutServo.attach(SERVO_PIN); mouthServo.write(90); }void loop(){ /* Durasi */ durasi panjang yang tidak ditandatangani; int jarak; //Jarak /* Mengirim sinyal dari pin TRIG */ digitalWrite(trig, 0); //Hentikan penundaan pin trigonometriMikrodetik(2); //Menunda 2 mikro detik digitalWrite(trig, 1); //Kirim sinyal dari TRIG pin delayMicroseconds(10); //Menunda 10 mikro detik digitalWrite(trig, 0); //Hentikan pin trigonometri /* Ukur lebar pulsa TINGGI pada pin ECHO */ durasi =pulseIn(echo, HIGH); //Hitung jarak jarak =int(durasi/2/29.412); if(jarak <=5) { //Jarak cetak Serial.println("jarak kurang dari 5 cm"); // Mulai buka mulut mulutServo.write(0); // Penundaan penundaan(1200); } else { //Cetak jarak Serial.println("jaraknya lebih dari 5 cm"); // Tutup mulut mulutServo.write(90); } // Delay delay(200);}

Skema