#define Trigpin1 33
#define Echopin1 34
#define Trigpin2 19
#define Echopin2 18
#define Trigpin3 27
#define Echopin3 26
#define Ledkanan 23
#define Ledkiri 22
#define Sensorapi 2
unsigned int NilaiIR;
long duration, distance;
unsigned int Bacajarak(int Trigpin, int Echopin) {
digitalWrite(Trigpin, LOW);
delay(2);
digitalWrite(Trigpin, HIGH);
delay(6);
digitalWrite(Trigpin, LOW);
delay(2);
duration = pulseIn(Echopin, HIGH);
distance = (duration * 0.034) / 2;
return distance;
}
void setup() {
Serial.begin(115200);
pinMode(Trigpin1, OUTPUT);
pinMode (Echopin1, INPUT);
pinMode(Trigpin2, OUTPUT);
pinMode (Echopin2, INPUT);
pinMode(Trigpin3, OUTPUT);
pinMode (Echopin3, INPUT);
pinMode (Ledkanan, OUTPUT);
pinMode (Ledkiri, OUTPUT);
pinMode (Sensorapi, INPUT);
}
void loop() {
int NilaiIR = analogRead(Sensorapi);
unsigned int Jarakdepan = (Trigpin1, Echopin1);
unsigned int Jarakkanan = (Trigpin2, Echopin2);
unsigned int Jarakkiri = (Trigpin3, Echopin3);
if (NilaiIR < 2000) {
digitalWrite (Ledkanan, HIGH);
digitalWrite (Ledkiri, HIGH);
Serial.println("Sensor IR mendeteksi api");
Serial.println("LED KANAN MENYALA");
Serial.println ("LED KIRI MENYALA");
}
else if (Jarakdepan < 100) {
digitalWrite (Ledkanan, HIGH);
digitalWrite (Ledkiri, HIGH);
Serial.println("Berhenti");
}
else if (Jarakkanan < 50 ){
digitalWrite (Ledkanan, LOW);
digitalWrite (Ledkiri, HIGH);
Serial.println("Belok Kiri");
}
else if (Jarakkiri < 50){
digitalWrite (Ledkanan, HIGH);
digitalWrite (Ledkiri, LOW);
Serial.println("Belok Kanan");
}
else {
digitalWrite (Ledkanan, LOW);
digitalWrite (Ledkiri, LOW);
Serial.println ("Maju");
}
}