Anda di halaman 1dari 1

/*

http://roboticbasics.blogspot.com
Ultrasonic sensor Pins:
VCC: +5VDC
Trig : Trigger (INPUT) - Pin11
Echo : Echo (OUTPUT) - Pin 12
GND : GND
*/
int trigPin = 11; //Trig - green Jumper
int echoPin = 12; //Echo - yellow Jumper
long duration, cm, meter;
void setup() {
//Serial Port begin
Serial.begin (9600);
//Define inputs and outputs
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}
void loop()
{
// Sensor dipicu oleh pulsa HIGH dari 10us atau lebih.
// Berikan pulsa LOW pendek terlebih dahulu untuk memastikan pulsa HIGH bersih:
digitalWrite(trigPin, LOW);
delayMicroseconds(5);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
// Baca sinyal dari sensor: pulsa HIGH yang
// duration adalah waktu (dalam mikrodetik) dari pengirim
// Dari ping untuk penerimaan Echo off dari sebuah objek.
pinMode(echoPin, INPUT);
duration = pulseIn(echoPin, HIGH);
// convert jarak kedalam cm dan meter
cm = (duration/2) / 29.1;
meter = (duration/2) / 100;
Serial.print(meter);
Serial.print("m, ");
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(250);
}

Anda mungkin juga menyukai