ใบงานที่ 7 Measure Distance with Arduino and Ultrasonic Sensor

ผู้จัดทำ

1.นางสาวณัฐธิชา ชนเก่าน้อย 011

2. นางสาวกุลจิรา       ทองคง 003

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

1.โฟโต้บอร์ด            1 บอร์ด

2. บอร์ด Arduino      1 บอร์ด

3. สายอัพโหลด        1 สาย

4. สายไฟผู้-ผู้            7 สาย

5. HC-SR04              1  ตัว

6. Servo motor          1  ตัว

รูปวงจร

https://drive.google.com/open?id=1vOD4lh30W6uZirgGt8_FkXfTm7-LLvkP

 Code

#include <Servo.h> //Load Servo Library int trigPin=13; //Sensor Trip pin connected to Arduino pin 13 int echoPin=11; //Sensor Echo pin connected to Arduino pin 11 int servoControlPin=6; //Servo control line is connected to pin 6 float pingTime; //time for ping to travel from sensor to target and return float targetDistance; //Distance to Target in inches float speedOfSound=776.5; //Speed of sound in miles per hour when temp is 77 degrees. float servoAngle; //Variable for the value we want to set servo to. Servo myPointer; //Create a servo object called myPointer void setup() { // put your setup code here, to run once: Serial.begin(9600); pinMode(servoControlPin, OUTPUT); pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); myPointer.attach(servoControlPin); //Tell arduino where the servo is attached. } void loop() { // put your main code here, to run repeatedly: digitalWrite(trigPin, LOW); //Set trigger pin low delayMicroseconds(2000); //Let signal settle digitalWrite(trigPin, HIGH); //Set trigPin high delayMicroseconds(15); //Delay in high state digitalWrite(trigPin, LOW); //ping has now been sent delayMicroseconds(10); //Delay in low state pingTime = pulseIn(echoPin, HIGH); //pingTime is presented in microceconds pingTime=pingTime/1000000; //convert pingTime to seconds by dividing by 1000000 (microseconds in a second) pingTime=pingTime/3600; //convert pingtime to hourse by dividing by 3600 (seconds in an hour) targetDistance= speedOfSound * pingTime; //This will be in miles, since speed of sound was miles per hour targetDistance=targetDistance/2; //Remember ping travels to target and back from target, so you must divide by 2 for actual target distance. targetDistance= targetDistance*63360; //Convert miles to inches by multipling by 63360 (inches per mile) Serial.print("The Distance to Target is: "); Serial.print(targetDistance); Serial.println(" inches"); servoAngle = (106./7.) * targetDistance + 37; //Calculate Servo Angle from targetDistance myPointer.write(servoAngle); //write servoAngle to the servo Serial.println(servoAngle); delay(100); //delay tenth of a second to slow things down a little. } #include <Servo.h> //Load Servo Library int trigPin=13; //Sensor Trip pin connected to Arduino pin 13 int echoPin=11; //Sensor Echo pin connected to Arduino pin 11 int servoControlPin=6; //Servo control line is connected to pin 6 float pingTime; //time for ping to travel from sensor to target and return float targetDistance; //Distance to Target in inches float speedOfSound=776.5; //Speed of sound in miles per hour when temp is 77 degrees. float servoAngle; //Variable for the value we want to set servo to. Servo myPointer; //Create a servo object called myPointer void setup() { // put your setup code here, to run once: Serial.begin(9600); pinMode(servoControlPin, OUTPUT); pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); myPointer.attach(servoControlPin); //Tell arduino where the servo is attached. } void loop() { // put your main code here, to run repeatedly: digitalWrite(trigPin, LOW); //Set trigger pin low delayMicroseconds(2000); //Let signal settle digitalWrite(trigPin, HIGH); //Set trigPin high delayMicroseconds(15); //Delay in high state digitalWrite(trigPin, LOW); //ping has now been sent delayMicroseconds(10); //Delay in low state pingTime = pulseIn(echoPin, HIGH); //pingTime is presented in microceconds pingTime=pingTime/1000000; //convert pingTime to seconds by dividing by 1000000 (microseconds in a second) pingTime=pingTime/3600; //convert pingtime to hourse by dividing by 3600 (seconds in an hour) targetDistance= speedOfSound * pingTime; //This will be in miles, since speed of sound was miles per hour targetDistance=targetDistance/2; //Remember ping travels to target and back from target, so you must divide by 2 for actual target distance. targetDistance= targetDistance*63360; //Convert miles to inches by multipling by 63360 (inches per mile) Serial.print("The Distance to Target is: "); Serial.print(targetDistance); Serial.println(" inches"); servoAngle = (106./7.) * targetDistance + 37; //Calculate Servo Angle from targetDistance myPointer.write(servoAngle); //write servoAngle to the servo Serial.println(servoAngle); delay(100); //delay tenth of a second to slow things down a little. }

https://drive.google.com/open?id=1sTR56HGCnt9UTASsikptBIDItvp2GAVD

คำอธิบายหลักการทำงาน

- วัดระยะทางแสดงผลโดยใช้ Servo motor (เข็มชี้ตัวเลข)

- Monitor แสดงผล ระยะทางในหน่วยของนิ้ว และ เซนติเมตร

- Monitor แสดงผลมุมของ Servo (Angle)