int tragPin = 13;
int echaPin = 12;
int ladPin = 11;//kabel putih
int trigPin = 10;
int echiPin = 9;
int lidPin = 8;//kabel biru
int trugPin = 7;
int echuPin = 6;
int ludPin = 5;//kabel kuning
long duration, cm, inches;
void setup() {
pinMode(tragPin, OUTPUT);
pinMode(echaPin, INPUT);
pinMode(ladPin, OUTPUT);
pinMode(trigPin, OUTPUT);
pinMode(echiPin, INPUT);
pinMode(lidPin, OUTPUT);
pinMode(trugPin, OUTPUT);
pinMode(echuPin, INPUT);
pinMode(ludPin, OUTPUT);
}
void loop() {
digitalWrite(tragPin, LOW);
delayMicroseconds(5);
digitalWrite(tragPin, HIGH);
delayMicroseconds(10);
digitalWrite(tragPin, LOW);
pinMode(echaPin, INPUT);
duration = pulseIn(echaPin, HIGH);
cm = (duration/2) / 29.1;
inches = (duration/2) / 74;
if (cm < 100)
{
digitalWrite(ladPin, LOW);
}
else {
digitalWrite(ladPin, HIGH);
}
digitalWrite(trigPin, LOW);
delayMicroseconds(5);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
pinMode(echiPin, INPUT);
duration = pulseIn(echiPin, HIGH);
cm = (duration/2) / 29.1;
inches = (duration/2) / 74;
if (cm < 100)
{
digitalWrite(lidPin, LOW);
}
else {
digitalWrite(lidPin, HIGH);
}
digitalWrite(trugPin, LOW);
delayMicroseconds(5);
digitalWrite(trugPin, HIGH);
delayMicroseconds(10);
digitalWrite(trugPin, LOW);
pinMode(echuPin, INPUT);
duration = pulseIn(echuPin, HIGH);
cm = (duration/2) / 29.1;
inches = (duration/2) / 74;
if (cm < 100)
{
digitalWrite(ludPin, LOW);
}
else {
digitalWrite(ludPin, HIGH);
}
}