Mengontrol Servo dengan Arduino dan 2 Sensor Ultrasonic

بِسْــــــــــــــــمِ اﷲِالرَّحْمَنِ اارَّحِيم

Halo bro, berjumpa kembali dengan ane di Minggu ketiga pada Bulan Suci Ramadhan.
Tidak terasa, tinggal menghitung hari lagi akan datang Hari Raya bagi yang merayakannya :)  

Yap, setelah sekian lama ane jarang mengecek draft blogger ini, hari ini ane sempatkan untuk membuka kembali akun blogger ini untuk memposting tutorial Arduino yang sudah ane simpan di draft, karena kalau tidak di publish dalam waktu yang cepat mungkin akan "Basi" hehehe.

Tutorial ini sebenarnya adalah salah satu request pengunjung blog BoArduino ini. 

Pada saat bulan Februari 2016 kemarin ada salah satu agan yang kirim email ke ane, dia ingin membuat Tempat sampah otomatis dengan arduino, yang cara kerjanya adalah dengan menggunakan 2 sensor ultrasonik. Sensor 1 untuk mendeteksi objek manusianya dan Sensor 2 untuk mendeteksi isi dari tempat sampah, apabila isinya penuh maka tempat sampah tidak akan membuka dan memutar suara "Maaf, tempat sampah sudah terisi penuh".

Tetapi pada tutorial ini, kita tidak akan memutar file audio yang memberikan pesan tersebut. Karena ini hanyalah contoh kecil dari penggunaan sensor ultrasonik lebih dari 1 menggunakan arduino. Diharapkan dari tutorial sederhana ini, ente dapat mengembangkanya lebih jauh.

Alat dan Bahan yang dibutuhkan :

• 1x Arduino UNO
• 1x Motor Servo 
• 2x Sensor Ultrasonik
• Kabel jumper secukupnya
• Breadboard (Project Board)

 Langkah - Langkahnya :

1.) Pertama, susunlah rangkaian seperti gambar dibawah ini

Keterangan Konfigurasi Kabel :

• Pin 5V pada Arduino dihubungkan ke VCC pada kedua sensor dan kabel merah servo.
• Pin GND pada Arduino dihubungkan ke GND pada kedua sensor dan kabel hitam servo.
• Pin 6 pada Arduino dihubungkan ke kabel kuning motor servo
• Pin 7 pada Arduino dihubungkan ke Echo Pin Sensor ultrasonik 1
• Pin 8 pada Arduino dihubungkan ke Trig Pin Sensor ultrasonik 1
• Pin 9 pada Arduino dihubungkan ke Echo Pin Sensor ultrasonik 2
• Pin 10 pada Arduino dihubungkan ke Trig Pin Sensor ultrasonik 2

2.) Setelah itu sambungkan Arduino pada Laptop/PC dengan menggunakan kabel serial.
3.) Download dan Install program Arduino IDE di Arduino.cc ( If Needed )
4.) Setelah terinstall, jalankan program Arduino-nya.
5.) Klik menu "Tools -> Board -> Arduino Uno"
6.) Klik menu "Tools -> Port -> ( Pilih Port arduino yang terdeteksi di komputer anda )
7.) Lalu masukan Sketch dibawah ini, dan terakhir klik upload.

Klik LIHAT DONG untuk melihat sketch

#include <NewPing.h>
#include <Servo.h>
#define TRIGGER_PIN   8
#define ECHO_PIN      7
#define TRIGGER_PIN2  10
#define ECHO_PIN2     9
#define MAX_DISTANCE 200

Servo servoAne;
NewPing ultrasonic1(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
NewPing ultrasonic2(TRIGGER_PIN2, ECHO_PIN2, MAX_DISTANCE);

void setup() {
  Serial.begin(115200);
  servoAne.attach(6);
  servoAne.write(0);
}

void loop() {
  delay(50);
  int US1 = ultrasonic1.ping_cm();
  int US2 = ultrasonic2.ping_cm();
  Serial.print("Hasil Sensor 1 :");
  Serial.print(US1);
  Serial.print("cm     |     ");
  Serial.print("Hasil Sensor 2 :");
  Serial.print(US2);
  Serial.println("cm");
  
  if(US1 <= 5 && US2 >= 6){
    servoAne.write(180);
    delay(5);
  }
  else if(US1 <= 5 && US2 <= 5){
    servoAne.write(0);
    delay(5);
  }
  else{
    servoAne.write(0);
    delay(5);
  }
}

Terimakasih telah berkunjung, selamat mencoba, semoga bermanfaat.