#define trigPin 7
#define echoPin 6
int led1 =2;
int led2 =3;
int jarakMAX = 250;
int jarakMin = 2;
long microSecond, jarakCm;
int ledTime =450;
void setup() {
Serial.begin (9600); //Kecepatan komunikasi serial
pinMode(trigPin, OUTPUT); //Set pin Trigger sebagai output
pinMode(echoPin, INPUT); //Set pin Echo sebagai input
}
void loop() {
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
microSecond = pulseIn(echoPin, HIGH);
jarakCm = microSecond / 58.3;
if (jarakCm >= jarakMAX)
{
Serial.println("....>250cm");
}
else if (jarakCm < 5)
{
Serial.println("<5 cm");
}
else if (jarakCm < 10)
{
Serial.println("<10 cm");
}
else if (jarakCm <= jarakMin)
{
Serial.println("....<2cm");
}
else {
Serial.print(jarakCm);
Serial.println("cm");
}
delay(100);
}
Tidak ada komentar:
Posting Komentar