#define Trigger 2 // กำหนดตัวเเปร Trigger ที่ขา 2
#define Echo 3 // กำหนดตัวเเปร Echo ที่ขา 3
#define Echo 3 // กำหนดตัวเเปร Echo ที่ขา 3
int timetaken, dist;
int sendv;void setup() {
Serial.begin (9600);
pinMode(Trigger, OUTPUT);
pinMode(Echo, INPUT);
}
void loop() {
timetaken=dist=0; //กำหนดให้ตัวเเปร timetaken=dist=0
digitalWrite(Trigger, HIGH);
digitalWrite(Trigger, LOW);
timetaken = pulseIn(Echo, HIGH);
dist = (timetaken/2) / 2.91;
if (dist <= 200 && dist > 0) //ถ้าdist<=200 เเละน้อยกว่า 0
sendv = dist;
Serial.println(sendv);
delay(200);
}
ไม่มีความคิดเห็น:
แสดงความคิดเห็น