Interfacing: ใบงานที่ 4 การใช้งานเซ็นเซอร์วัดระยะททาง HC

ผู้จัดทำ

นาย คมสันต์ รั่วลี 1 สทค 1 6031280004

นาย ชัยวัฒน์ มาลาเอี่ยม 1 สทค 1 6031280010

อุปกรณ์ที่ใช้

1. ตัวต้านทาน 220R 6 ตัว

2. สายไฟ 11 เส้น

3. บอร์ด Arduino

4. สาย USB

5. โฟโต้บอร์ด
6. HC - SR04

Code

const int trigPin = 9;

const int echoPin = 10;

int LED1=3;

int LED2=4;

int LED3=5;

int LED4=6;

int LED5=7;

int LED6=8;

float duration, distance;

void setup() {

pinMode(trigPin, OUTPUT);

pinMode(echoPin, INPUT);

pinMode (LED1,OUTPUT);

pinMode (LED2,OUTPUT);

pinMode (LED3,OUTPUT);

pinMode (LED4,OUTPUT);

pinMode (LED5,OUTPUT);

pinMode (LED6,OUTPUT);

Serial.begin(9600);

}

void loop() {

digitalWrite(trigPin, LOW);

delayMicroseconds(2);

digitalWrite(trigPin, HIGH);

delayMicroseconds(10);

digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);

distance = (duration*.0343)/2;

Serial.print("Distance: ");

Serial.println(distance);

delay(100);

if(distance <= 30)

{

digitalWrite (LED1,HIGH);

digitalWrite (LED2,HIGH);

}

if(distance > 30)

{

digitalWrite (LED1,LOW);

digitalWrite (LED2,LOW);

}

if(distance <= 20)

{

digitalWrite (LED3,HIGH);

digitalWrite (LED4,HIGH);

}

if(distance > 20)

{

digitalWrite (LED3,LOW);

digitalWrite (LED4,LOW);

}

if(distance <= 10)

{

digitalWrite (LED5,HIGH);

digitalWrite (LED6,HIGH);

}

if(distance > 10)

{

digitalWrite (LED5,LOW);

digitalWrite (LED6,LOW);

}

if(distance <= 6)

{

digitalWrite (LED1,HIGH);

digitalWrite (LED2,HIGH);

digitalWrite (LED3,HIGH);

digitalWrite (LED4,HIGH);

digitalWrite (LED5,HIGH);

digitalWrite (LED6,HIGH);

delay(300);

digitalWrite (LED1,LOW);

digitalWrite (LED2,LOW);

digitalWrite (LED3,LOW);

digitalWrite (LED4,LOW);

digitalWrite (LED5,LOW);

digitalWrite (LED6,LOW);

delay(300);

}

delay(300);

}

ดาวโหลด Code : คลิก!
-------------------------------------------------------------------------------------

คำอธิบาย

ถ้าระยะทางตั้งแต่ 21-30 ซม. LED สีเขียวติด 2 ดวง ถ้าระยะทางตั้งแต่ 11-20 ซม. LED สีเหลืองติด 2 ดวง(สีเขียว ยังคงติด) ถ้าระยะทางตั้งแต่ 6-10 ซม. LED สีแดงติด 2 ดวง(สีเขียวและสีเหลือง ยังคงติด) ถ้าระยะ น้อยกว่า 6 ให้ LE กระพริบทั้ง 6 ดวง (ติด 0.3 วินาที ดับ 0.3 วินาที)

รูปภาพ